Subversion Repositories planix.SVN

#include <u.h>
#include <libc.h>
#include <bio.h>

#include "pci.h"
#include "vga.h"

/*
 * Sierra SC1502[56] HiCOLOR-24 Palette.
 */
static void
pixmask(void)
{
        inportb(PaddrW);
}

static void
commandrw(void)
{
        int i;

        pixmask();
        for(i = 0; i < 4; i++)
                inportb(Pixmask);
}

static uchar
commandr(void)
{
        uchar command;

        commandrw();
        command = inportb(Pixmask);
        pixmask();

        return command;
}

static void
commandw(uchar command)
{
        commandrw();
        outportb(Pixmask, command);
        pixmask();
}

static void
options(Vga*, Ctlr* ctlr)
{
        ctlr->flag |= Foptions;
}

static void
init(Vga* vga, Ctlr* ctlr)
{
        ulong pclk;
        char *p;

        /*
         * Part comes in -125, -110, -80, and -66MHz speed-grades.
         * Work out the part speed-grade from name.  Name can have,
         * e.g. '-110' on the end  for 100MHz part.
         */
        pclk = 66000000;
        if(p = strrchr(ctlr->name, '-'))
                pclk = strtoul(p+1, 0, 0) * 1000000;

        /*
         * If we don't already have a desired pclk,
         * take it from the mode.
         * Check it's within range.
         */
        if(vga->f[0] == 0)
                vga->f[0] = vga->mode->frequency;
        if(vga->f[0] > pclk)
                error("%s: invalid pclk - %ld\n", ctlr->name, vga->f[0]);
}

static void
load(Vga*, Ctlr*)
{
        uchar aux, command;

        aux = 0x00;
        /*
        if(vga->mode->z == 8)
                aux = 0x01;
         */
        commandrw();
        command = inportb(Pixmask);
        outportb(Pixmask, command|0x18);
        outportb(PaddrR, 0x08);
        outportb(PaddrW, aux);
        commandw(command);
}

static void
dump(Vga*, Ctlr* ctlr)
{
        int i;
        uchar command;

        printitem(ctlr->name, "command");
        command = commandr();
        printreg(command);

        printitem(ctlr->name, "index08");
        commandw(command|0x10);
        for(i = 0x08; i < 0x11; i++){
                outportb(PaddrR, i);
                printreg(inportb(PaddrW));
        }
        commandw(command);
}

Ctlr sc15025 = {
        "sc15025",                      /* name */
        0,                              /* snarf */
        options,                        /* options */
        init,                           /* init */
        load,                           /* load */
        dump,                           /* dump */
};