draw.c

/*
# _____     ___ ____     ___ ____
#  ____|   |    ____|   |        | |____|
# |     ___|   |____ ___|    ____| |    \    PS2DEV Open Source Project.
#-----------------------------------------------------------------------
# (c) 2009 Lion
# Licenced under Academic Free License version 2.0
# Review ps2sdk README & LICENSE files for further details.
*/
 
#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <sys/fcntl.h>
#include <sys/unistd.h>
#include <kernel.h>
#include <libgs.h>
 
#include "internal.h"
 
extern QWORD GsPrimWorkArea[];
 
void GsSetDefaultDrawEnv(GS_DRAWENV *drawenv, u16 psm, u16 w, u16 h)
{
    drawenv->offset_x   = 2048-w/2;
    drawenv->offset_y   = 2048-h/2;
    drawenv->clip.x     = 0;
    drawenv->clip.y     = 0;
    drawenv->clip.w     = w;
    drawenv->clip.h     = h;
    drawenv->draw_mask  = 0;
    drawenv->auto_clear = 1;
 
    drawenv->bg_color.r = 0x01;
    drawenv->bg_color.g = 0x01;
    drawenv->bg_color.b = 0x01;
    drawenv->bg_color.a = 0x80;
    drawenv->bg_color.q = 0.0f;
 
    drawenv->fbw = (w+63)/64;
    drawenv->psm = psm;
    drawenv->vram_addr = 0;
    drawenv->vram_x = 0;
    drawenv->vram_y = 0;
}
 
void GsSetDefaultDrawEnvAddress(GS_DRAWENV *drawenv, u16 vram_addr)
{
    drawenv->vram_addr=vram_addr;
}
 
int checkModelVersion(void)
{
    int fd, result;
    char data[256];
 
    if((fd=open("rom0:ROMVER", O_RDONLY))>=0)
    {
        int i;
        char *pData;
        for(pData=data,i=0; (unsigned int)i<sizeof(data); i++)
        {
            read(fd, pData, 1);
            if(*pData++=='\0') break;
        }
        close(fd);
 
        //ROMVER string format: VVVVRTYYYYMMDD\n
        result=(20010608<atoi(data+i-9));
    }
    else result=-1;
 
    return result;
}
 
void GsSetDefaultDisplayEnv(GS_DISPENV *dispenv, u16 psm, u16 w, u16 h, u16 dx, u16 dy)
{
    GsGParam_t *pGParams;
    int gs_DH, gs_DW, gs_DY, gs_DX;
 
    pGParams=GsGetGParam();
    dispenv->disp.pad1=dispenv->disp.pad2=0;
 
    if(pGParams->omode >= GS_MODE_NTSC && pGParams->omode <= GS_MODE_PAL)
    {
        gs_DH=0;
        gs_DW=0;
        gs_DY=0;
        gs_DX=0;
    } else {
        if(checkModelVersion())
            _GetGsDxDyOffset(pGParams->omode, &gs_DX, &gs_DY, &gs_DW, &gs_DH);
        else{
            gs_DH=0;
            gs_DW=0;
            gs_DY=0;
            gs_DX=0;
        }
    }
 
    dispenv->dispfb.pad1=dispenv->dispfb.pad2=0;
    dispenv->dispfb.x=0;
    dispenv->dispfb.y=0;
    dispenv->dispfb.address=0;
    dispenv->dispfb.fbw=(w+63)/64;
    dispenv->dispfb.psm=psm;
    switch(pGParams->omode)
    {
        case GS_MODE_NTSC:
            if(pGParams->interlace)
            {
                dispenv->disp.display_y = dy+gs_DY+0x32;
                dispenv->disp.display_x = (gs_DX+0x27C) + dx*((w+0x9FF)/w);
                dispenv->disp.magnify_h = (w+0x9FF)/w - 1;
                dispenv->disp.magnify_v = 0;
                dispenv->disp.display_w = (w+0x9FF)/w*w - 1;
 
                if(pGParams->ffmode)
                    dispenv->disp.display_h = (h<<1) - 1;
                else
                    dispenv->disp.display_h = h - 1;
            } else {
                dispenv->disp.display_h = h-1;
                dispenv->disp.display_x = gs_DX+0x27C + dx*((w+0x9FF)/w);
                dispenv->disp.display_y = gs_DY+dy+0x19;
                dispenv->disp.magnify_h = (w+0x9FF)/w - 1;
                dispenv->disp.magnify_v = 0;
                dispenv->disp.display_w = (w+0x9FF)/w*w - 1;
            }
            break;
        case GS_MODE_PAL:
            if(pGParams->interlace)
            {
                dispenv->disp.display_y = gs_DY+dy+0x48;
                dispenv->disp.display_x = gs_DX+0x290 + dx*((w+0x9FF)/w);
                dispenv->disp.magnify_h = (w+0x9FF)/w - 1;
                dispenv->disp.magnify_v = 0;
                dispenv->disp.display_w = (w+0x9FF)/w*w - 1;
 
                if(pGParams->ffmode)
                    dispenv->disp.display_h = (h<<1) - 1;
                else
                    dispenv->disp.display_h = h - 1;
            } else {
                dispenv->disp.display_h = h-1;
                dispenv->disp.display_x = gs_DX+0x290 + dx*((w+0x9FF)/w);
                dispenv->disp.display_y = dy+gs_DY+0x48;
                dispenv->disp.magnify_h = (w+0x9FF)/w - 1;
                dispenv->disp.magnify_v = 0;
                dispenv->disp.display_w = (w+0x9FF)/w*w - 1;
            }
            break;
        case GS_MODE_DTV_480P:
            dispenv->disp.display_x = gs_DX+((0x2D0-w) + ((0x2D0-w)>>31))/2*2 + (dx<<1)+0xE8;
            dispenv->disp.display_h = h-1;
            dispenv->disp.display_w = (w<<1) - 1;
            dispenv->disp.display_y = gs_DY+dy+0x23;
            dispenv->disp.magnify_h = 1;
            dispenv->disp.magnify_v = 0;
            break;
        default:
            printf("GsSetDefaultDisplayEnv: Unsupported video mode: 0x%x\n", pGParams->omode);
    }
}
 
void GsSetDefaultDisplayEnvAddress(GS_DISPENV *dispenv, unsigned short vram_addr)
{
    dispenv->dispfb.address=vram_addr;
}
 
void GsPutDrawEnv1(GS_DRAWENV *drawenv)
{
    GsSetXYOffset1(drawenv->offset_x<<4, drawenv->offset_y<<4);
    GsSetScissor1(drawenv->clip.x, drawenv->clip.y, drawenv->clip.x+drawenv->clip.w, drawenv->clip.y+drawenv->clip.h);
    GsSetFrame1(drawenv->vram_addr, drawenv->fbw, drawenv->psm, drawenv->draw_mask);
 
    //use a sprite to clear background
    if(drawenv->auto_clear)
    {
        GsClearDrawEnv1(drawenv);
    }
}
 
void GsClearDrawEnv1(GS_DRAWENV *drawenv)
{
    unsigned char context;
    QWORD *p;
 
    // use a sprite to clear background
    context =0; // contex 1
 
    p=UNCACHED_SEG(GsPrimWorkArea);
    gs_setGIF_TAG(((GS_GIF_TAG *)&p[0]), 4,1,0,0,GS_GIF_PACKED,1,gif_rd_ad);
    gs_setR_PRIM(((GS_R_PRIM *)&p[1]), GS_PRIM_SPRITE,0, 0, 0, 1, 0, 1, context, 0);
    gs_setR_RGBAQ(((GS_R_RGBAQ *)&p[2]), drawenv->bg_color.r, drawenv->bg_color.g, drawenv->bg_color.b, drawenv->bg_color.a, drawenv->bg_color.q);
    gs_setR_XYZ2(((GS_R_XYZ *)&p[3]), (drawenv->offset_x+drawenv->clip.x)<<4, (drawenv->offset_y+drawenv->clip.y)<<4, 0x00000000);
    gs_setR_XYZ2(((GS_R_XYZ *)&p[4]), (drawenv->offset_x+drawenv->clip.x+drawenv->clip.w)<<4, (drawenv->offset_y+drawenv->clip.y+drawenv->clip.h)<<4, 0x00000000);
 
    GsDmaSend(GsPrimWorkArea, 5);
    GsDmaWait();
}
 
void GsPutDisplayEnv1(GS_DISPENV *dispenv)
{
    *((volatile GS_DISPLAY *)(gs_p_display1)) =  dispenv->disp;
    *((volatile GS_DISPFB *)(gs_p_dispfb1)) =  dispenv->dispfb;
}
 
void GsPutDrawEnv2(GS_DRAWENV *drawenv)
{
    GsSetXYOffset2(drawenv->offset_x<<4, drawenv->offset_y<<4);
    GsSetScissor2(drawenv->clip.x, drawenv->clip.y, drawenv->clip.x+drawenv->clip.w, drawenv->clip.y+drawenv->clip.h);
    GsSetFrame2(drawenv->vram_addr, drawenv->fbw, drawenv->psm, drawenv->draw_mask);
 
    if(drawenv->auto_clear)
    {
        GsClearDrawEnv2(drawenv);
    }
}
 
void GsClearDrawEnv2(GS_DRAWENV *drawenv)
{
    unsigned char context;
    QWORD *p;
 
    // use a sprite to clear background
    context =1; // contex 2
 
    p=UNCACHED_SEG(GsPrimWorkArea);
    gs_setGIF_TAG(((GS_GIF_TAG *)&p[0]), 4,1,0,0,GS_GIF_PACKED,1,gif_rd_ad);
    gs_setR_PRIM(((GS_R_PRIM *)&p[1]), GS_PRIM_SPRITE,0, 0, 0, 1, 0, 1, context, 0);
    gs_setR_RGBAQ(((GS_R_RGBAQ *)&p[2]), drawenv->bg_color.r, drawenv->bg_color.g, drawenv->bg_color.b, drawenv->bg_color.a, drawenv->bg_color.q);
    gs_setR_XYZ2(((GS_R_XYZ *)&p[3]), (drawenv->offset_x+drawenv->clip.x)<<4, (drawenv->offset_y+drawenv->clip.y)<<4, 0x00000000);
    gs_setR_XYZ2(((GS_R_XYZ *)&p[4]), (drawenv->offset_x+drawenv->clip.x+drawenv->clip.w)<<4, (drawenv->offset_y+drawenv->clip.y+drawenv->clip.h)<<4, 0x00000000);
 
    GsDmaSend(GsPrimWorkArea, 5);
    GsDmaWait();
}
 
void GsPutDisplayEnv2(GS_DISPENV *dispenv)
{
    *((volatile GS_DISPLAY *)(gs_p_display2)) =  dispenv->disp;
    *((volatile GS_DISPFB *)(gs_p_dispfb2)) =  dispenv->dispfb;
}