/**
 ** ndrvr32.h ---- the new 32bpp (24bpp padded) linear in-memory and
 **                video frame buffer drivers
 **
 ** Copyright (c) 2019 Mariano Alvarez Fernandez
 ** [e-mail: malfer@telefonica.net]
 **
 ** This file is part of the GRX graphics library.
 **
 ** The GRX graphics library is free software; you can redistribute it
 ** and/or modify it under some conditions; see the "copying.grx" file
 ** for details.
 **
 ** This library 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.
 **
 ** This driver doesn't use all the memfill, mempeek infraestructure, only
 ** C standard bit operations and C standard functions.
 **/

/* frame offset address calculation */
#define FOFS(x,y,lo) umuladd32((y),(lo),((x)<<2))

static INLINE
GrColor readpixel(GrFrame *c, int x, int y)
{
    GR_int32u *ptr;

    GRX_ENTER();
    ptr  = (GR_int32u *)&c->gf_baseaddr[0][FOFS(x,y,c->gf_lineoffset)];
    GRX_RETURN(PIX2COL(*ptr));
}

static INLINE
void drawpixel(int x, int y, GrColor color)
{
    GR_int32u *ptr, xcolor;
    int op;

    GRX_ENTER();
    ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
    op = C_OPER(color);
    xcolor = COL2PIX(color);
    switch(op) {
        case C_XOR: *ptr ^= xcolor; break;
        case C_OR:  *ptr |= xcolor; break;
        case C_AND: *ptr &= xcolor; break;
        default:    *ptr = xcolor; break;
    }
    GRX_LEAVE();
}

static void drawvline(int x, int y, int h, GrColor color)
{
    unsigned lwdt;
    GR_int32u *ptr, xcolor;
    int op, i;

    GRX_ENTER();
    lwdt = (CURC->gc_lineoffset) >> 2;
    ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
    op = C_OPER(color);
    xcolor = COL2PIX(color);
    switch(op) {
        case C_XOR: for (i=0; i<h; i++) {*ptr ^= xcolor; ptr += lwdt;} break;
        case C_OR:  for (i=0; i<h; i++) {*ptr |= xcolor; ptr += lwdt;} break;
        case C_AND: for (i=0; i<h; i++) {*ptr &= xcolor; ptr += lwdt;} break;
        default:    for (i=0; i<h; i++) {*ptr = xcolor; ptr += lwdt;} break;
    }
    GRX_LEAVE();
}

static void drawhline(int x, int y, int w, GrColor color)
{
    GR_int32u *ptr, xcolor;
    int op, i;

    GRX_ENTER();
    ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
    op   = C_OPER(color);
    xcolor= COL2PIX(color);
    switch(op) {
        case C_XOR: for (i=0; i<w; i++) {*ptr ^= xcolor; ptr++;} break;
        case C_OR:  for (i=0; i<w; i++) {*ptr |= xcolor; ptr++;} break;
        case C_AND: for (i=0; i<w; i++) {*ptr &= xcolor; ptr++;} break;
        default:    for (i=0; i<w; i++) {*ptr = xcolor; ptr++;} break;
    }
    GRX_LEAVE();
}

static void drawblock(int x, int y, int w, int h, GrColor color)
{
    int j;
    
    GRX_ENTER();
    for (j=0; j<h; j++) {
        drawhline(x,y,w,color);
        y++;
    }
    GRX_LEAVE();
}

static void drawline(int x, int y, int dx, int dy, GrColor color)
{
    GR_int32u *ptr, xcolor;
    int cnt, err, yoff, op;
    
    GRX_ENTER();
    op = C_OPER(color);
    xcolor = COL2PIX(color);

    yoff = 1;
    if (dx < 0) {
        x += dx; dx = (-dx);
        y += dy; dy = (-dy);
    }
    if (dy < 0) {
        yoff = (-1);
        dy   = (-dy);
    }
    if (dx > dy) {
        err = (cnt = dx) >> 1;
        do {
            ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
            switch(op) {
                case C_XOR: *ptr ^= xcolor; break;
                case C_OR:  *ptr |= xcolor; break;
                case C_AND: *ptr &= xcolor; break;
                default:    *ptr = xcolor; break;
            }
            if ((err -= dy) < 0) err += dx,y += yoff;
            x++;
        } while(--cnt >= 0);
    }
    else {
        err = (cnt = dy) >> 1;
        do {
            ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
            switch(op) {
                case C_XOR: *ptr ^= xcolor; break;
                case C_OR:  *ptr |= xcolor; break;
                case C_AND: *ptr &= xcolor; break;
                default:    *ptr = xcolor; break;
            }
            if ((err -= dx) < 0) err += dy,x++;
            y += yoff;
        } while(--cnt >= 0);
    }
    GRX_LEAVE();
}

static void drawbitmap(int x, int y, int w, int h, char *bmp, int pitch,
                       int start, GrColor fg, GrColor bg)
{
    GR_int32u *ptr, xcolorfg, xcolorbg;
    int opfg, opbg;
    unsigned char *bitp;
    unsigned char bits;
    unsigned char mask;
    int xx;

    GRX_ENTER();
    opfg = C_OPER(fg);
    xcolorfg = COL2PIX(fg);
    if (fg == GrNOCOLOR) opfg = -1; // special value to do nothing in switch
    opbg = C_OPER(bg);
    xcolorbg = COL2PIX(bg);
    if (bg == GrNOCOLOR) opbg = -1; // special value to do nothing in switch

    h += y;
    bmp += (unsigned int)start >> 3;
    start &= 7;
    do {
        ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];
        bitp = (unsigned char *)bmp;
        bits = *bitp;
        mask = 0x80 >> start;
        xx = 0;
        do {
            if (bits & mask) {
                switch(opfg) {
                    case C_XOR:   *ptr ^= xcolorfg; break;
                    case C_OR:    *ptr |= xcolorfg; break;
                    case C_AND:   *ptr &= xcolorfg; break;
                    case C_WRITE: *ptr = xcolorfg; break;
                }
            } else {
                switch(opbg) {
                    case C_XOR:   *ptr ^= xcolorbg; break;
                    case C_OR:    *ptr |= xcolorbg; break;
                    case C_AND:   *ptr &= xcolorbg; break;
                    case C_WRITE: *ptr = xcolorbg; break;
                }
            }
            if ((mask >>= 1) == 0) bits = *++bitp, mask = 0x80;
            ptr++;
        } while (++xx != w);
        bmp += pitch;
    } while (++y != h);
    GRX_LEAVE();
}

static void drawpattern(int x, int y, int w, char patt, GrColor fg, GrColor bg)
{
    //no mejorada por no tener caso de uso
    GR_int8u mask;

    GRX_ENTER();
    mask = 0x80;
    w += x;
    do {
        drawpixel(x, y, (patt & mask) ? fg : bg);
        if((mask >>= 1) == 0) mask = 0x80;
    } while (++x != w);
    GRX_LEAVE();
}

static void bitbltovl(GrFrame *dst, int dx, int dy,
                      GrFrame *src, int sx, int sy,
                      int w, int h, GrColor op)
{
    GR_int32u *sptr, sbuf[w], *dptr;
    GR_int32u skipc;
    int op2, i, j;
    int sypos, dypos, incr;

    GRX_ENTER();
    op2 = C_OPER(op);
    skipc = COL2PIX(op & GrCVALUEMASK);

    // can overlap so check for blit direction
    if(sy <= dy) {
        sypos = sy + h - 1;
        dypos = dy + h - 1;
        incr = -1;
    } else {
        sypos = sy;
        dypos = dy;
        incr = 1;
    }
    
    for (i=0; i<h; i++) {
        sptr = (GR_int32u *)&src->gf_baseaddr[0][FOFS(sx,sypos,src->gf_lineoffset)];
        memcpy((void *)sbuf, (void *)sptr, sizeof(GR_int32u)*w);
        dptr = (GR_int32u *)&dst->gf_baseaddr[0][FOFS(dx,dypos,dst->gf_lineoffset)];
        switch(op2) {
            case C_XOR:
                for (j=0; j<w; j++) {*dptr ^= sbuf[j]; dptr++;}
                break;
            case C_OR:
                for (j=0; j<w; j++) {*dptr |= sbuf[j]; dptr++;}
                break;
            case C_AND:
                for (j=0; j<w; j++) {*dptr &= sbuf[j]; dptr++;}
                break;
            case C_IMAGE:
                for (j=0; j<w; j++) {
                    if (sbuf[j] != skipc)
                        *dptr =sbuf[j];
                    dptr++;
                }
                break;
            default:
                memcpy((void *)dptr, (void *)sbuf, sizeof(GR_int32u)*w); // C_WRITE
                break;
        }
        sypos += incr;
        dypos += incr;
    }
    GRX_LEAVE();
}

static void bitbltnoo(GrFrame *dst, int dx, int dy,
                      GrFrame *src, int sx, int sy,
                      int w, int h, GrColor op)
{
    GR_int32u *sptr, *dptr;
    GR_int32u skipc;
    int op2, i, j;

    GRX_ENTER();
    op2 = C_OPER(op);
    skipc = COL2PIX(op & GrCVALUEMASK);

    for (i=0; i<h; i++) {
        sptr = (GR_int32u *)&src->gf_baseaddr[0][FOFS(sx,sy+i,src->gf_lineoffset)];
        dptr = (GR_int32u *)&dst->gf_baseaddr[0][FOFS(dx,dy+i,dst->gf_lineoffset)];
        switch(op2) {
            case C_XOR:
                for (j=0; j<w; j++) {*dptr ^= *sptr; sptr++; dptr++;}
                break;
            case C_OR:
                for (j=0; j<w; j++) {*dptr |= *sptr; sptr++; dptr++;}
                break;
            case C_AND:
                for (j=0; j<w; j++) {*dptr &= *sptr; sptr++; dptr++;}
                break;
            case C_IMAGE:
                for (j=0; j<w; j++) {
                    if (*sptr != skipc)
                        *dptr = *sptr;
                    sptr++;
                    dptr++;
                }
                break;
            default:
                memcpy((void *)dptr, (void *)sptr, sizeof(GR_int32u)*w);
                break;
        }
    }
    GRX_LEAVE();
}

static
GrColor *getindexedscanline(GrFrame *c, int x, int y, int w, int *indx)
{
    GR_int32u *ptr;
    GrColor *pixels;
    int i;

    if (indx) return _GrFrDrvGenericGetIndexedScanline(c,x,y,w,indx);
    
    GRX_ENTER();
    pixels = _GrTempBufferAlloc(sizeof(GrColor) * (w+1));
    ptr = (GR_int32u *)&c->gf_baseaddr[0][FOFS(x,y,c->gf_lineoffset)];
    if (pixels) {
        for (i=0; i<w; i++) {
            pixels[i] = PIX2COL(*ptr);
            ptr++;
        }
    }
    GRX_RETURN(pixels);
}

static
void putscanline(int x, int y, int w, const GrColor *scl, GrColor op)
{
    GR_int32u *ptr;
    GrColor skipc;
    int op2, i;

    GRX_ENTER();
    op2 = C_OPER(op);
    skipc = op & GrCVALUEMASK;
    ptr = (GR_int32u *)&CURC->gc_baseaddr[0][FOFS(x,y,CURC->gc_lineoffset)];

    switch(op2) {
        case C_XOR:
            for (i=0; i<w; i++) {*ptr ^= COL2PIX(scl[i]); ptr++;}
            break;
        case C_OR:
            for (i=0; i<w; i++) {*ptr |= COL2PIX(scl[i]); ptr++;}
            break;
        case C_AND:
            for (i=0; i<w; i++) {*ptr &= COL2PIX(scl[i]); ptr++;}
            break;
        case C_IMAGE:
            for (i=0; i<w; i++) {
                if (scl[i] != skipc)
                    *ptr = COL2PIX(scl[i]);
                ptr++;
            }
            break;
        default:
            for (i=0; i<w; i++) {*ptr = COL2PIX(scl[i]); ptr++;}
            break;
    }
    GRX_LEAVE();
}