#include "acrtc.h"

int *acrtc_ar=(int*)ACRTC_BASE;               /* pointer - address register  */
int *acrtc_sr=(int*)ACRTC_BASE;               /* pointer - status register   */
int *acrtc_io=(int*)ACRTC_BASE+2;             /* pointer - register i/o port */

chk_ced()
{
    int status;
    status=(int)*acrtc_sr;
    status &= 1<<CED;
    while(status==0)
    {
        status=(int)*acrtc_sr;
//      printf("not ready for command - status $%04x\n",status);
        status &= 1<<CED;
    }
}

chk_wfr()
{
    int status;
    status=(int)*acrtc_sr;
    status &= 1<<WFR;
    while(status==0)
    {
        status=(int)*acrtc_sr;
        printf("fifo not ready - status $%04x\n",status);
        status &= 1<<WFR;
    }
}

fifo_write(data)
int data;
{
    chk_wfr();
    *acrtc_io=data;
}

pr_write(pr,data)
int pr,data;
{
    fifo_write(pr+0x0800);
    fifo_write(data);
}

cls(dn)
int dn;                           /* acrtc display number (0-3) */
{
    *acrtc_ar=0;                  /* address the fifo */
    pr_write(0x0c,dn*16384);      /* set RWP (read write pointer (high word) */
    pr_write(0x0d,0);             /* set RWP (read write pointer (low word)  */
    chk_ced();
    fifo_write(CLR);              /* write CLR command  */
    fifo_write(0);                /* write D  parameter */
    fifo_write((HRES/PIXW)-1);    /* write AX parameter */
    fifo_write(0-(VRES-1));       /* write AY parameter */
}

line(x1,y1,x2,y2)
int x1,y1,x2,y2;
{
    chk_ced();
    fifo_write(AMOVE);            /* write AMOVE command */
    fifo_write(x1);               /* write X parameter   */
    fifo_write(y1);               /* write Y parameter   */
    chk_ced();
    fifo_write(ALINE);            /* write ALINE command */
    fifo_write(x2);               /* write X parameter   */
    fifo_write(y2);               /* write Y parameter   */
}

rectangle(x1,y1,x2,y2)
int x1,y1,x2,y2;
{
    chk_ced();
    fifo_write(AMOVE);            /* write AMOVE command */
    fifo_write(x1);               /* write X parameter   */
    fifo_write(y1);               /* write Y parameter   */
    chk_ced();
    fifo_write(ARCT);             /* write ARCT command  */
    fifo_write(x2);               /* write X parameter   */
    fifo_write(y2);               /* write Y parameter   */
}

circle(x,y,r)
int x,y,r;
{
    chk_ced();
    fifo_write(AMOVE);            /* write AMOVE command */
    fifo_write(x);                /* write X parameter   */
    fifo_write(y);                /* write Y parameter   */
    chk_ced();
    fifo_write(CRCL);             /* write CRCL command  */
    fifo_write(r);                /* write R parameter   */
}

delay(t)
long t;
{
    while(t!=0)
    {
        t--;
    }
}