Subversion Repositories shark

Rev

Rev 2 | Blame | Compare with Previous | Last modification | View Log | RSS feed

#include <ll/i386/hw-data.h>
#include <ll/i386/hw-instr.h>
#include <ll/i386/mem.h>
#include <ll/stdlib.h>

#include <drivers/gd.h>

#include "fun16.h"

#define fontaddr       0xffa6eL     /* indirizzo set caratteri         */

extern DWORD flbaddr;

void RdWin_Hi(WORD x1, WORD y1, WORD x2, WORD y2, BYTE *buf)
{
    WORD b_bank, b_offset, display_ptr;
    int dx, len1, len2, bank_num, row;
/*    int bank, enmem;*/
    DWORD end_of_line, display_offset;
    WORD bytes_per_row;
    LIN_ADDR p;

    bytes_per_row = gd_getbpr();
    p = buf;

    Seg_Off_Hi(x1, y1, bytes_per_row, &b_offset, &b_bank);
    dx = (x2 - x1) + 1;
    /*dx = (x2 - x1);*/
    row = y1;
    display_offset = b_offset;
    display_ptr = display_offset;
    bank_num = b_bank;
    Load_Write_Bank_256(bank_num);
    do {
        end_of_line = display_ptr + (2 * (x2 - x1));
        if (end_of_line >= 65536L) {
            len2 = (1 + (end_of_line - 65536L) / 2);
            len1 = dx - len2;
/*              Clr_Part(color, length_1, display_ptr);*/
            memcpy(p, (LIN_ADDR)(0xA0000 + display_ptr), len1 * 2); /* NON CI VA *2???*/
            p += len1 * 2;
            bank_num++;
            Load_Write_Bank_256(bank_num);
            display_ptr = 0;
/*              Clr_Part(color, length_2, display_ptr);*/
            memcpy(p, (LIN_ADDR)(0xA0000 + display_ptr), len2 * 2); /* NON CI VA * 2 ???*/
            p += len2 * 2;
            display_ptr = (bytes_per_row - (len1 * 2));
        } else {
/*      Clr_Part(color, dx, display_ptr);*/
            memcpy(p, (LIN_ADDR)(0xA0000 + display_ptr), dx * 2); /* NON CI VA * 2 ???*/
            p += (dx * 2);
            display_offset = (DWORD)display_ptr + (DWORD)bytes_per_row;
            if (display_offset >= 65536L) {
                bank_num++;
                Load_Write_Bank_256(bank_num);
                display_ptr = display_offset - 65536L;
            } else {
                display_ptr += bytes_per_row;
            }  
        }
        row++;
    } while (row <= y2);
    Load_Write_Bank_256(0);
}

void WrWin_Hi(WORD x1, WORD y1, WORD x2, WORD y2, BYTE *buf)
{
    WORD b_bank, b_offset, display_ptr;
    int dx, len1, len2, bank_num, row;
/*    int bank, enmem;*/
    DWORD end_of_line, display_offset;
    WORD bytes_per_row;
    LIN_ADDR p;

    bytes_per_row = gd_getbpr();
    p = buf;

    Seg_Off_Hi(x1, y1, bytes_per_row, &b_offset, &b_bank);
    dx = (x2 - x1) + 1;
    /*dx = (x2 - x1);*/
    row = y1;
    display_offset = b_offset;
    display_ptr = display_offset;
    bank_num = b_bank;
    Load_Write_Bank_256(bank_num);
    do {
        end_of_line = display_ptr + (2 * (x2 - x1));
        if (end_of_line >= 65536L) {
            len2 = (1 + (end_of_line - 65536L) / 2);
            len1 = dx - len2;
/*              Clr_Part(color, length_1, display_ptr);*/
            memcpy((LIN_ADDR)(0xA0000 + display_ptr), p, len1 * 2); /* NON CI VA *2???*/
            p += len1 * 2;
            bank_num++;
            Load_Write_Bank_256(bank_num);
            display_ptr = 0;
/*              Clr_Part(color, length_2, display_ptr);*/
            memcpy((LIN_ADDR)(0xA0000 + display_ptr), p, len2 * 2); /* NON CI VA * 2 ???*/
            p += len2 * 2;
            display_ptr = (bytes_per_row - (len1 * 2));
        } else {
/*      Clr_Part(color, dx, display_ptr);*/
            memcpy((LIN_ADDR)(0xA0000 + display_ptr), p, dx * 2); /* NON CI VA * 2 ???*/
            p += (dx * 2);
            display_offset = (DWORD)display_ptr + (DWORD)bytes_per_row;
            if (display_offset >= 65536L) {
                bank_num++;
                Load_Write_Bank_256(bank_num);
                display_ptr = display_offset - 65536L;
            } else {
                display_ptr += bytes_per_row;
            }  
        }
        row++;
    } while (row <= y2);
    Load_Write_Bank_256(0);
}

void linPut16(WORD x1, WORD y1, WORD x2, WORD y2, BYTE *buf)
{
    WORD bpr;
    LIN_ADDR addr, p;
    WORD dx, y;
   
    bpr = gd_getbpr();
    p = buf;
    addr = (LIN_ADDR)(flbaddr + x1 * 2 + bpr * y1);
    dx = (x2 - x1 + 1) * 2;
    /*dx = (x2 - x1) * 2;*/

    for (y = y1; y <= y2; y++) {
        memcpy(addr, p, dx);
        p += dx;
        addr += bpr;
    }
}

void linGet16(WORD x1, WORD y1, WORD x2, WORD y2, BYTE *buf)
{
    WORD bpr;
    LIN_ADDR addr, p;
    WORD dx, y;
   
    bpr = gd_getbpr();
    p = buf;
    addr = (LIN_ADDR)(flbaddr + x1 * 2 + bpr * y1);
    dx = (x2 - x1 + 1) * 2;
    /*dx = (x2 - x1) * 2;*/

    for (y = y1; y <= y2; y++) {
        memcpy(p, addr, dx);
        p += dx;
        addr += bpr;
    }
}

void ClrWin_Hi(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    WORD b_bank, b_offset, display_ptr;
    int dx, len1, len2, bank_num, row;
/*    int bank, enmem;*/
    DWORD end_of_line, display_offset;
    WORD bytes_per_row;

    bytes_per_row = gd_getbpr();

    Seg_Off_Hi(x1, y1, bytes_per_row, &b_offset, &b_bank);
    dx = (x2 - x1) + 1;
    row = y1;
    display_offset = b_offset;
    display_ptr = display_offset;
    bank_num = b_bank;
    Load_Write_Bank_256(bank_num);
    do {
        end_of_line = display_ptr + (2 * (x2 - x1));
        if (end_of_line >= 65536L) {
            len2 = (1 + (end_of_line - 65536L) / 2);
            len1 = dx - len2;
/*              Clr_Part(color, length_1, display_ptr);*/
            memsetw((LIN_ADDR)(0xA0000 + display_ptr), color, len1 * 2); /* FORSE NON* 2???*/
            bank_num++;
            Load_Write_Bank_256(bank_num);
            display_ptr = 0;
/*              Clr_Part(color, length_2, display_ptr);*/
            memsetw((LIN_ADDR)(0xA0000 + display_ptr), color, len2 * 2); /* FORSE NON* 2??? */
            display_ptr = bytes_per_row - (2 * len1);
        } else {
/*          Clr_Part(color, dx, display_ptr);*/
            memsetw((LIN_ADDR)(0xA0000 + display_ptr), color, dx * 2); /* FORSE NON* 2??? */
            display_offset = (DWORD)display_ptr + (DWORD)bytes_per_row;
            if (display_offset >= 65536L) {
                bank_num++;
                Load_Write_Bank_256(bank_num);
                display_ptr = display_offset - 65536L;
            } else {
                display_ptr += bytes_per_row;
            }
        }
        row++;
    } while (row <= y2);
    Load_Write_Bank_256(0);
}

void linBox16(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    WORD bpr;
    DWORD addr;
    WORD dx, y;
   
    bpr = gd_getbpr();
    addr = flbaddr + x1 * 2 + bpr * y1;
    dx = (x2 - x1 + 1) * 2;
    /*dx = (x2 - x1) * 2;*/

    for (y = y1; y <= y2; y++) {
        memsetw((LIN_ADDR)addr, color, dx);
        addr += bpr;
    }
}

void WrRect_Hi(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    WORD bank, offs, ebank, eoffs;
    WORD bpr;
    WORD line_segment, len;
    WORD y;

    bpr = gd_getbpr();
    len = 1 + x2 - x1;
    Seg_Off_Hi(x2, y1, bpr, &eoffs, &ebank);
    Seg_Off_Hi(x1, y1, bpr, &offs, &bank);
    Load_Write_Bank_256(bank);
    if (bank == ebank) {
        memsetw((LIN_ADDR)(0xA0000 + offs), color, len * 2); /* NON CI VA * 2???*/
    } else {
        line_segment = 65536L - offs;
        memsetw((LIN_ADDR)(0xA0000 + offs), color, line_segment); /* NON CI VA * 2???*/
        Load_Write_Bank_256(ebank);
        memsetw((LIN_ADDR)0xA0000, color, eoffs); /* NON CI VA * 2??? */
    }
    for (y = y1 + 1; y <= y2 + 1; y++) {
        Seg_Off_Hi(x1, y, bpr, &offs, &bank);
        Load_Write_Bank_256(bank);
        lmempokew((LIN_ADDR)(0xA0000 + offs), color);
        Seg_Off_Hi(x2, y, bpr, &offs, &bank);
        Load_Write_Bank_256(bank);
        lmempokew((LIN_ADDR)(0xA0000 + offs), color);
    }
    Seg_Off_Hi(x2, y2, bpr, &eoffs, &ebank);
    Seg_Off_Hi(x1, y2, bpr, &offs, &bank);
    Load_Write_Bank_256(bank);
    if (bank == ebank) {
        memsetw((LIN_ADDR)(0xA0000 + offs), color, len * 2);  /* NON CI VA * 2???*/
    } else {
        line_segment = 65536L - offs;
        memsetw((LIN_ADDR)(0xA0000 + offs), color, line_segment);  /* NON CI VA * 2???*/
        Load_Write_Bank_256(ebank);
        memsetw((LIN_ADDR)0xA0000, color, eoffs);   /* NON CI VA * 2???*/
    }
}

void linRect16(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    WORD bpr;
    DWORD addr;
    WORD dx, y;
   
    bpr = gd_getbpr();
    addr = flbaddr + x1 * 2 + bpr * y1;
    dx = (x2 - x1) * 2;

    memsetw((LIN_ADDR)addr, color, dx+2);
    addr += bpr;

    for (y = y1 + 1; y <= y2 - 1; y++) {
        lmempokew((LIN_ADDR)addr, color);
        lmempokew((LIN_ADDR)(addr + dx), color);
        addr += bpr;
    }
    memsetw((LIN_ADDR)addr, color, dx+2);
}

void WrText_Hi(char *text, WORD x, WORD y, DWORD fg, DWORD bg)
{
    DWORD fp;
    WORD offs, bank;
    WORD bpr;
    int r, c, bits;

    bpr = gd_getbpr();
    while (*text) {
        fp = fontaddr + (8 * *(BYTE *)text);
        for (r=0; r<8; r++) {
            bits = lmempeekb((LIN_ADDR)(fp++));
            for (c=0; c<8; c++)
                if (bits & (0x80>>c)) {
                    Seg_Off_Hi(x + c, y + r, bpr, &offs, &bank);
                    Load_Write_Bank_256(bank);
                    lmempokew((LIN_ADDR)(0xA0000 + offs), fg);
                }
/*                  lmempokew((LIN_ADDR)(addr + (y + r) * bpr + x + c), fg);*/
/*                  vbe_putpixel((x+c),(y+r),fg);*/
                else {
                    Seg_Off_Hi(x + c, y + r, bpr, &offs, &bank);
                    Load_Write_Bank_256(bank);
                    lmempokew((LIN_ADDR)(0xA0000 + offs), bg);
                }
/*                  lmempokew((LIN_ADDR)(addr + (y + r) * bpr + x + c), bg);*/
/*                  vbe_putpixel((x+c), (y+r), bg);*/
        }
        text++;
        x += 8;
    }
}

void linText16(char *text, WORD x, WORD y, DWORD fg, DWORD bg)
{
    DWORD fp, addr;
    WORD bpr;
    int r, c, bits;

    bpr = gd_getbpr();
    addr = gd_getflb();
    while (*text) {
        /*DOSSetAddr(fp, (fontaddr + (8 * *(BYTE *)text)));*/
        /*DOSSetAddr(fp, (fontaddr + (8 * *(BYTE *)text)));*/
        fp = fontaddr + (8 * *(BYTE *)text);
        for (r=0; r<8; r++) {
            bits = lmempeekb((LIN_ADDR)fp++);
            for (c=0; c<8; c++)
                if (bits & (0x80>>c))
                    lmempokew((LIN_ADDR)(addr + (y + r) * bpr + ((x + c) * 2)), fg);
/*                  vbe_putpixel((x+c),(y+r),fg);*/
                else
                    lmempokew((LIN_ADDR)(addr + (y + r) * bpr + ((x + c) * 2)), bg);
/*                  vbe_putpixel((x+c), (y+r), bg);*/
        }
        text++;
        x += 8;
    }
}

void WrLine_Hi(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    int dx, dy, incr1, incr2, d, x, y, xend, yend, yinc, xinc;
    WORD bpr;
    WORD bank, offs, ebank, eoffs;
    WORD line_segment, len;

    bpr = gd_getbpr();
    if (y2 == y1) {
        y = y1;
        if (x1 > x2) {
            xend = x1;
            x1 = x2;
            x2 = xend;
        }
/*      WrHline_256(x1, x2, y1, color, bpr);    */
        len = 1 + x2 - x1;
        Seg_Off_Hi(x2, y, bpr, &eoffs, &ebank);
        Seg_Off_Hi(x1, y, bpr, &offs, &bank);
        Load_Write_Bank_256(bank);
        if (bank == ebank) {
            memsetw((LIN_ADDR)(0xA0000 + offs), color, len * 2);
        } else {
            line_segment = 65536L - offs;
            memsetw((LIN_ADDR)(0xA0000 + offs), color, line_segment);
            Load_Write_Bank_256(ebank);
            memsetw((LIN_ADDR)0xA0000, color, eoffs);
        }
    } else {
        dx = abs(x2 - x1);
        dy = abs(y2 - y1);
        if (dx >= dy) {
            if (x1 > x2) {
                x = x2;
                y = y2;
                xend = x1;
                if (dy == 0) {
                    yinc = 0;
                } else {
                    if (y2 > y1) {
                        yinc = -1;
                    } else {
                        yinc = 1;
                    }
                }
            } else {
                x = x1;
                y = y1;
                xend = x2;
                if (dy == 0) {
                    yinc = 0;
                } else {
                    if (y2 > y1) {
                        yinc =1;
                    } else {
                        yinc = -1;
                    }
                }
            }
            incr1 = 2 * dy;
            d = incr1 - dx;
            incr2 = 2 * (dy - dx);
            Seg_Off_Hi(x, y, bpr, &offs, &bank);
            Load_Write_Bank_256(bank);
            lmempokew((LIN_ADDR)(0xA0000 + offs), color);
            while (x < xend) {
                x++;
                if (d < 0) {
                    d += incr1;
                } else {
                    y += yinc;
                    d += incr2;
                }
                Seg_Off_Hi(x, y, bpr, &offs, &bank);
                Load_Write_Bank_256(bank);
                lmempokew((LIN_ADDR)(0xA0000 + offs), color);
            }
        } else {
            if (y1 > y2) {
                x = x2;
                y = y2;
                yend = y1;
                if (dx == 0) {
                    xinc = 0;
                } else {
                    if (x2 > x1) {
                        xinc = -1;
                    } else {
                        xinc = 1;
                    }
                }
            } else {
                x = x1;
                y = y1;
                yend = y2;
                if (dx == 0) {
                    xinc = 0;
                } else {
                    if (x2 > x1) {
                        xinc = 1;
                    } else {
                        xinc = -1;
                    }
                }
            }
            incr1 = 2 * dx;
            d = incr1 - dy;
            incr2 = 2 * (dx - dy);
            Seg_Off_Hi(x, y, bpr, &offs, &bank);
            Load_Write_Bank_256(bank);
            lmempokew((LIN_ADDR)(0xA0000 + offs), color);
            while (y < yend) {
                y++;
                if (d < 0) {
                    d += incr1;
                } else {
                    x += xinc;
                    d += incr2;
                }
                Seg_Off_Hi(x, y, bpr, &offs, &bank);
                Load_Write_Bank_256(bank);
                lmempokew((LIN_ADDR)(0xA0000 + offs), color);
            }
        }
    }
}

void linLine16(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color)
{
    register int t, distance;
    register DWORD addr;
    register WORD bpr;
    int xerr=0, yerr=0, deltax, deltay;
    int incx, incy;

    bpr = gd_getbpr();
    addr = gd_getflb();
    deltax = x2 - x1;                   /* compute both distances */
    deltay = y2 - y1;

    if (deltax > 0)                     /* compute increments */
        incx = 1;
    else if (deltax == 0)
        incx = 0;
    else
        incx = -1;

    if (deltay > 0)
        incy = 1;
    else if (deltay == 0)
        incy = 0;
    else
        incy = -1;

    deltax = abs(deltax);               /* determine greater distance */
    deltay = abs(deltay);
    if (deltax > deltay)
        distance = deltax;
    else
        distance = deltay;

    for (t=0; t<=distance+1; t++) {     /* draw the line */
/*      vbe_putpixel(x1, y1, colour);*/
        lmempokew((LIN_ADDR)(addr + y1 * bpr + (x1 * 2)), color);
        xerr += deltax;
        yerr += deltay;
        if (xerr > distance) {
            xerr -= distance;
            x1 += incx;
        }
        if (yerr > distance) {
            yerr -= distance;
            y1 += incy;
        }
    }
}

void WrPixel_Hi(WORD x, WORD y, DWORD color)
{
    WORD bpr;
    WORD bank, offs;

    bpr = gd_getbpr();
    Seg_Off_Hi(x, y, bpr, &offs, &bank);
    Load_Write_Bank_256(bank);
    lmempokew((LIN_ADDR)(0xA0000 + offs), color);
/*    Load_Write_Bank_256(0);*/
}

void linWr16(WORD x, WORD y, DWORD color)
{
    WORD bpr;

    bpr = gd_getbpr();
    lmempokew((LIN_ADDR)(flbaddr + y * bpr + (x * 2)), color);
}

DWORD RdPixel_Hi(WORD x, WORD y)
{
    WORD bpr;
    WORD bank, offs;
    DWORD rv;

    bpr = gd_getbpr();
    Seg_Off_Hi(x, y, bpr, &offs, &bank);
    Load_Write_Bank_256(bank);
    rv = lmempeekw((LIN_ADDR)(0xA0000 + offs));
    return rv;
}

DWORD linRd16(WORD x, WORD y)
{
    WORD bpr;
    DWORD rv;

    bpr = gd_getbpr();
    rv = lmempeekw((LIN_ADDR)(flbaddr + y * bpr + (x * 2)));
    return rv;
}