346 lines
8.8 KiB
C
346 lines
8.8 KiB
C
|
#include "grf.h"
|
||
|
|
#if NGRF > 0
|
||
|
|
|
||
|
|
/* Graphics routines for the AMIGA native custom chip set. */
|
||
|
|
|
||
|
|
#include "sys/param.h"
|
||
|
|
#include "sys/errno.h"
|
||
|
|
|
||
|
|
#include "grfioctl.h"
|
||
|
|
#include "grfvar.h"
|
||
|
|
#include "grf_ccreg.h"
|
||
|
|
|
||
|
|
#include "../include/cpu.h"
|
||
|
|
#include "../amiga/custom.h"
|
||
|
|
|
||
|
|
|
||
|
|
extern caddr_t CHIPMEMADDR;
|
||
|
|
extern caddr_t chipmem_steal ();
|
||
|
|
|
||
|
|
struct ccfb ccfb = {
|
||
|
|
DEF_DISP_WIDTH, DEF_DISP_HEIGHT, DEF_DISP_X, DEF_DISP_Y, DEF_DISP_Z,
|
||
|
|
0,
|
||
|
|
DEF_FB_WIDTH, DEF_FB_HEIGHT, DEF_FB_X, DEF_FB_Y, DEF_FB_Z,
|
||
|
|
DEF_COL0, DEF_COL1
|
||
|
|
};
|
||
|
|
|
||
|
|
/* Initialize one copper list. We'll need two to make a nice interlaced display. */
|
||
|
|
|
||
|
|
/* maximum size needed for a copper list (4 planes hires laced) */
|
||
|
|
#define COPENTS (4 * (2 * 4 + 2 + 1 + 2 + 2 + 2 + 16 * 1 + 1))
|
||
|
|
|
||
|
|
/* copper instructions */
|
||
|
|
#define MOVE(cl, reg, val) \
|
||
|
|
do { *cl++ = CUSTOM_OFS(reg); *cl++ = val; } while (0)
|
||
|
|
#define WAIT(cl, vp, hp, bfd, ve, he) \
|
||
|
|
do { *cl++ = ((vp & 0xff)<<8)|(hp & 0xfe)|1; \
|
||
|
|
*cl++ = (bfd<<15)|((ve & 0x7f)<<8)|(hp & 0xfe)|1; } while (0)
|
||
|
|
#define STOP(cl) \
|
||
|
|
do { *cl++ = 0xffff; *cl++ = 0xffff; } while (0)
|
||
|
|
|
||
|
|
static void
|
||
|
|
initcop (cop, othercop, shf, fb)
|
||
|
|
u_short *cop;
|
||
|
|
u_short *othercop;
|
||
|
|
int shf;
|
||
|
|
struct ccfb *fb;
|
||
|
|
{
|
||
|
|
long scrmem;
|
||
|
|
int i;
|
||
|
|
u_short c, strt, stop, *orig_cop = cop;
|
||
|
|
|
||
|
|
/* get PA of display area */
|
||
|
|
scrmem = (long) fb->fb - (long) CHIPMEMADDR;
|
||
|
|
|
||
|
|
othercop = (u_short *) ((long)othercop - (long) CHIPMEMADDR);
|
||
|
|
|
||
|
|
/* account for possible interlaced half-frame */
|
||
|
|
if (shf)
|
||
|
|
scrmem += fb->fb_width >> 3;
|
||
|
|
|
||
|
|
/* account for oversized framebuffers */
|
||
|
|
scrmem += (fb->fb_x >> 3) + (fb->fb_y * (fb->fb_width >> 3));
|
||
|
|
|
||
|
|
/* initialize bitplane pointers for all planes */
|
||
|
|
/* remember offset in copperlist to patch later */
|
||
|
|
if (! fb->bplstart_off)
|
||
|
|
fb->bplstart_off = cop - orig_cop;
|
||
|
|
for (i = 0; i < fb->disp_z; i++)
|
||
|
|
{
|
||
|
|
MOVE (cop, bplpth(i), scrmem >> 16);
|
||
|
|
MOVE (cop, bplptl(i), scrmem & 0xffff);
|
||
|
|
scrmem += (fb->fb_width >> 3) * fb->fb_height;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* modulo is one line for interlaced displays, plus difference between
|
||
|
|
virtual and effective framebuffer size */
|
||
|
|
MOVE (cop, bpl1mod, (fb->fb_width + (fb->fb_width - fb->disp_width)) >> 3);
|
||
|
|
MOVE (cop, bpl2mod, (fb->fb_width + (fb->fb_width - fb->disp_width)) >> 3);
|
||
|
|
|
||
|
|
c = 0x8000 /* HIRES */
|
||
|
|
| ((fb->disp_z & 7) << 12) /* bitplane use */
|
||
|
|
| 0x0200 /* composite COLOR enable (whatever this is..) */
|
||
|
|
| 0x0004; /* LACE */
|
||
|
|
|
||
|
|
MOVE (cop, bplcon0, c);
|
||
|
|
|
||
|
|
/* these use pre-ECS register interpretation. Might want to go ECS ? */
|
||
|
|
strt = (((fb->disp_y >> 1) & 0xff)<<8) | ((fb->disp_x >> 1) & 0xff);
|
||
|
|
MOVE (cop, diwstrt, strt);
|
||
|
|
stop = (((((fb->disp_y + fb->disp_height + 1-shf)>>1) & 0xff)<<8)
|
||
|
|
| (((fb->disp_x + fb->disp_width)>>1) & 0xff));
|
||
|
|
MOVE (cop, diwstop, stop);
|
||
|
|
/* NOTE: default values for strt: 0x2c81, stop: 0xf4c1 */
|
||
|
|
|
||
|
|
/* these are from from HW-manual.. */
|
||
|
|
strt = ((strt & 0xff) - 9) >> 1;
|
||
|
|
MOVE (cop, ddfstrt, strt);
|
||
|
|
stop = strt + (((fb->disp_width >> 4) - 2) << 2);
|
||
|
|
MOVE (cop, ddfstop, stop);
|
||
|
|
|
||
|
|
/* setup interlaced display by constantly toggling between two copperlists */
|
||
|
|
MOVE (cop, cop1lch, (long)othercop >> 16);
|
||
|
|
MOVE (cop, cop1lcl, (long)othercop & 0xffff);
|
||
|
|
|
||
|
|
for (i = 0; i < (1 << fb->disp_z); i++)
|
||
|
|
MOVE (cop, color[i], fb->col[i]);
|
||
|
|
|
||
|
|
/* wait forever */
|
||
|
|
STOP (cop);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
#ifdef DEBUG
|
||
|
|
void
|
||
|
|
dump_copperlist (cl)
|
||
|
|
u_int *cl;
|
||
|
|
{
|
||
|
|
while (*cl != 0xffffffff)
|
||
|
|
{
|
||
|
|
if (!(*cl & 0x00010000))
|
||
|
|
printf ("MOVE (%x, %x)\t", *cl & 0xffff, *cl >> 16);
|
||
|
|
else
|
||
|
|
printf ("WAIT (%d, %d, %d, %d, %d)\t", *cl >> 24, (*cl & 0x00fe0000)>>16,
|
||
|
|
(*cl & 0x8000)>> 15, (*cl & 0x7f00)>>8, (*cl & 0xfe));
|
||
|
|
cl++;
|
||
|
|
}
|
||
|
|
printf ("STOP ()\n");
|
||
|
|
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Initialize hardware.
|
||
|
|
* Must point g_display at a grfinfo structure describing the hardware.
|
||
|
|
* Returns 0 if hardware not present, non-zero ow.
|
||
|
|
*/
|
||
|
|
cc_init(gp, ad)
|
||
|
|
struct grf_softc *gp;
|
||
|
|
struct amiga_device *ad;
|
||
|
|
{
|
||
|
|
register struct ccfb *fb = &ccfb;
|
||
|
|
struct grfinfo *gi = &gp->g_display;
|
||
|
|
u_char *fbp, save;
|
||
|
|
int fboff, fbsize;
|
||
|
|
int s;
|
||
|
|
|
||
|
|
/* if already initialized, fail */
|
||
|
|
if (fb->fb)
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
/* testing for the result is really redundant because chipmem_steal
|
||
|
|
panics if it runs out of memory.. */
|
||
|
|
fbsize = (fb->fb_width >> 3) * fb->fb_height * fb->fb_z;
|
||
|
|
if (! (fb->fb = (u_char *) chipmem_steal (fbsize))
|
||
|
|
|| !(fb->cop1 = (u_short *) chipmem_steal (COPENTS))
|
||
|
|
|| !(fb->cop2 = (u_short *) chipmem_steal (COPENTS)))
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
/* clear the display. bzero only likes regions up to 64k, so call multiple times */
|
||
|
|
for (fboff = 0; fboff < fbsize; fboff += 64*1024)
|
||
|
|
bzero (fb->fb + fboff, fbsize - fboff > 64*1024 ? 64*1024 : fbsize - fboff);
|
||
|
|
|
||
|
|
initcop (fb->cop1, fb->cop2, 0, fb);
|
||
|
|
initcop (fb->cop2, fb->cop1, 1, fb);
|
||
|
|
|
||
|
|
/* Make sure no ex-sprites are streaking down the screen */
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
for(i = 0;i < 8;i++)
|
||
|
|
{
|
||
|
|
custom.spr[i].data = 0;
|
||
|
|
custom.spr[i].datb = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* start the new display */
|
||
|
|
/* disable these */
|
||
|
|
custom.dmacon = (DMAF_BLTDONE | DMAF_BLTNZERO | DMAF_BLITHOG | DMAF_BLITTER
|
||
|
|
| DMAF_SPRITE | DMAF_DISK
|
||
|
|
| DMAF_AUD3 | DMAF_AUD2 | DMAF_AUD1 | DMAF_AUD0);
|
||
|
|
/* enable these */
|
||
|
|
custom.dmacon = DMAF_SETCLR | DMAF_MASTER | DMAF_RASTER | DMAF_COPPER;
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
/* ok, this is a bit rough.. */
|
||
|
|
s = splhigh ();
|
||
|
|
/* load a first guess copperlist, verify later whether we got the right
|
||
|
|
one */
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop1 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0;
|
||
|
|
/* reset VBL */
|
||
|
|
custom.intreq = INTF_VERTB;
|
||
|
|
/* wait for VBL */
|
||
|
|
while (! (custom.intreqr & INTF_VERTB)) ;
|
||
|
|
/* reset VBL */
|
||
|
|
custom.intreq = INTF_VERTB;
|
||
|
|
/* now, in a safe location, set correct copperlist based on longframe/shortframe
|
||
|
|
bit */
|
||
|
|
if (custom.vposr & 0x8000)
|
||
|
|
{
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop1 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0; /* strobe it */
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop2 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0;
|
||
|
|
}
|
||
|
|
/* wait for another VBL and reset int, then go back to previous int level */
|
||
|
|
while (! (custom.intreqr & INTF_VERTB)) ;
|
||
|
|
custom.intreq = INTF_VERTB;
|
||
|
|
splx (s);
|
||
|
|
#else
|
||
|
|
s = splhigh();
|
||
|
|
/* set up copper */
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop1 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0;
|
||
|
|
|
||
|
|
/* reset vertical blank interrupt */
|
||
|
|
custom.intreq = INTF_VERTB;
|
||
|
|
|
||
|
|
/* wait for vertical blank interrupt */
|
||
|
|
while ((custom.intreqr & INTF_VERTB) != INTF_VERTB)
|
||
|
|
;
|
||
|
|
|
||
|
|
/* set bitplane pointers based on LOF/SHF bit */
|
||
|
|
if (custom.vposr & 0x8000)
|
||
|
|
{
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop1 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
custom.cop1lc = (void *) ((long)fb->cop2 - (long) CHIPMEMADDR);
|
||
|
|
custom.copjmp1 = 0;
|
||
|
|
}
|
||
|
|
splx (s);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/* tame the blitter. Copying one word onto itself should put it into
|
||
|
|
a consistent state. This is black magic... */
|
||
|
|
custom.bltapt =
|
||
|
|
custom.bltbpt =
|
||
|
|
custom.bltcpt =
|
||
|
|
custom.bltdpt = 0;
|
||
|
|
custom.bltamod =
|
||
|
|
custom.bltbmod =
|
||
|
|
custom.bltcmod =
|
||
|
|
custom.bltdmod = 0;
|
||
|
|
custom.bltafwm =
|
||
|
|
custom.bltalwn = 0xffff;
|
||
|
|
custom.bltcon0 = 0x09f0;
|
||
|
|
custom.bltcon1 = 0;
|
||
|
|
custom.bltsize = 1;
|
||
|
|
|
||
|
|
/* enable VBR interrupts. This is also done in the serial driver, but it
|
||
|
|
really belongs here.. */
|
||
|
|
custom.intena = INTF_SETCLR | INTF_VERTB;
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
#ifdef DEBUG
|
||
|
|
/* prove the display is up.. */
|
||
|
|
for (fboff = 0; fboff < fbsize; fboff++)
|
||
|
|
{
|
||
|
|
fb->fb[fboff] = 0xff;
|
||
|
|
DELAY(10);
|
||
|
|
}
|
||
|
|
for (fboff = 0; fboff < fbsize; fboff++)
|
||
|
|
{
|
||
|
|
fb->fb[fboff] = 0;
|
||
|
|
DELAY(10);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
gi->gd_regaddr = (caddr_t) fb; /* XXX */
|
||
|
|
gi->gd_regsize = 0;
|
||
|
|
|
||
|
|
gi->gd_fbaddr = fb->fb - (u_char *) CHIPMEMADDR;
|
||
|
|
gi->gd_fbsize = fbsize;
|
||
|
|
|
||
|
|
gi->gd_colors = 1 << fb->fb_z;
|
||
|
|
gi->gd_planes = fb->fb_z;
|
||
|
|
|
||
|
|
gi->gd_fbwidth = fb->fb_width;
|
||
|
|
gi->gd_fbheight = fb->fb_height;
|
||
|
|
gi->gd_fbx = fb->fb_x;
|
||
|
|
gi->gd_fby = fb->fb_y;
|
||
|
|
gi->gd_dwidth = fb->disp_width;
|
||
|
|
gi->gd_dheight = fb->disp_height;
|
||
|
|
gi->gd_dx = fb->disp_x;
|
||
|
|
gi->gd_dy = fb->disp_y;
|
||
|
|
|
||
|
|
gp->g_regkva = 0; /* builtin */
|
||
|
|
gp->g_fbkva = fb->fb;
|
||
|
|
|
||
|
|
return(1);
|
||
|
|
}
|
||
|
|
|
||
|
|
cc_config(gp, di)
|
||
|
|
register struct grf_softc *gp;
|
||
|
|
struct grfdyninfo *di;
|
||
|
|
{
|
||
|
|
register struct ccfb *fb = &ccfb;
|
||
|
|
struct grfinfo *gi = &gp->g_display;
|
||
|
|
u_char *fbp, save;
|
||
|
|
int fboff, fbsize;
|
||
|
|
int s;
|
||
|
|
|
||
|
|
/* bottom missing... */
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Change the mode of the display.
|
||
|
|
* Right now all we can do is grfon/grfoff.
|
||
|
|
* Return a UNIX error number or 0 for success.
|
||
|
|
*/
|
||
|
|
cc_mode(gp, cmd, arg)
|
||
|
|
register struct grf_softc *gp;
|
||
|
|
int cmd;
|
||
|
|
void *arg;
|
||
|
|
{
|
||
|
|
switch (cmd)
|
||
|
|
{
|
||
|
|
case GM_GRFON:
|
||
|
|
custom.dmacon = DMAF_SETCLR | DMAF_RASTER | DMAF_COPPER;
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
case GM_GRFOFF:
|
||
|
|
custom.dmacon = DMAF_RASTER | DMAF_COPPER;
|
||
|
|
return 0;
|
||
|
|
|
||
|
|
case GM_GRFCONFIG:
|
||
|
|
return cc_config (gp, (struct grfdyninfo *) arg);
|
||
|
|
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|