131 lines
3.0 KiB
C
131 lines
3.0 KiB
C
|
#include <sys/param.h>
|
||
|
|
#include <sys/device.h>
|
||
|
|
|
||
|
|
#include <machine/pio.h>
|
||
|
|
#include <machine/autoconf.h>
|
||
|
|
#include <machine/grfioctl.h>
|
||
|
|
|
||
|
|
#include <dev/pci/pcireg.h>
|
||
|
|
#include <dev/pci/pcivar.h>
|
||
|
|
#include <dev/pci/pcidevs.h>
|
||
|
|
#include <dev/ofw/openfirm.h>
|
||
|
|
|
||
|
|
#include <macppc/dev/grfvar.h>
|
||
|
|
|
||
|
|
caddr_t videoaddr;
|
||
|
|
int videorowbytes;
|
||
|
|
int videobitdepth;
|
||
|
|
int videosize;
|
||
|
|
static struct grfinfo ati_display;
|
||
|
|
|
||
|
|
static void grf_ati_attach __P((struct device *, struct device *, void *));
|
||
|
|
static int grf_ati_match __P((struct device *, struct cfdata *, void *));
|
||
|
|
|
||
|
|
static int ati_mode __P((struct grf_softc *, int, void *));
|
||
|
|
|
||
|
|
struct grf_ati_softc {
|
||
|
|
struct device sc_dev;
|
||
|
|
};
|
||
|
|
|
||
|
|
struct cfattach grfati_ca = {
|
||
|
|
sizeof(struct grf_ati_softc), grf_ati_match, grf_ati_attach
|
||
|
|
};
|
||
|
|
|
||
|
|
int
|
||
|
|
grf_ati_match(parent, cf, aux)
|
||
|
|
struct device *parent;
|
||
|
|
struct cfdata *cf;
|
||
|
|
void *aux;
|
||
|
|
{
|
||
|
|
struct pci_attach_args *pa = aux;
|
||
|
|
|
||
|
|
if (PCI_CLASS(pa->pa_class) == PCI_CLASS_DISPLAY &&
|
||
|
|
PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_DISPLAY_VGA &&
|
||
|
|
/* PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_MACH64_GX && */
|
||
|
|
PCI_VENDOR(pa->pa_id) == PCI_VENDOR_ATI)
|
||
|
|
return 1;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void
|
||
|
|
grf_ati_attach(parent, self, aux)
|
||
|
|
struct device *parent, *self;
|
||
|
|
void *aux;
|
||
|
|
{
|
||
|
|
struct pci_attach_args *pa = (struct pci_attach_args *)aux;
|
||
|
|
int csr;
|
||
|
|
int width, height, node;
|
||
|
|
u_int reg[5];
|
||
|
|
caddr_t regaddr;
|
||
|
|
struct grf_attach_args ga;
|
||
|
|
char type[32];
|
||
|
|
extern int console_node;
|
||
|
|
|
||
|
|
printf("\n");
|
||
|
|
csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
|
||
|
|
|
||
|
|
csr |= PCI_COMMAND_MEM_ENABLE;
|
||
|
|
pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* OF_open("/bandit/ATY,mach64") hangs... so we can use
|
||
|
|
* framebuffer when it is specified as a console.
|
||
|
|
*/
|
||
|
|
|
||
|
|
node = console_node;
|
||
|
|
if (node == -1)
|
||
|
|
return;
|
||
|
|
|
||
|
|
bzero(type, sizeof(type));
|
||
|
|
OF_getprop(node, "device_type", type, sizeof(type));
|
||
|
|
if (strcmp(type, "display") != 0)
|
||
|
|
return;
|
||
|
|
|
||
|
|
OF_getprop(node, "assigned-addresses", reg, sizeof(reg));
|
||
|
|
|
||
|
|
regaddr = mapiodev(reg[2] + 0x800000 - 0x400, 0x400);
|
||
|
|
videoaddr = mapiodev(reg[2] + 0x400 , reg[4] - 0x400);
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* set character color to rgb:ff/ff/ff
|
||
|
|
*/
|
||
|
|
#define DAC_W_INDEX 0xc0
|
||
|
|
#define DAC_DATA 0xc1
|
||
|
|
|
||
|
|
out8(regaddr + DAC_W_INDEX, 255);
|
||
|
|
out8(regaddr + DAC_DATA, 255);
|
||
|
|
out8(regaddr + DAC_DATA, 255);
|
||
|
|
out8(regaddr + DAC_DATA, 255);
|
||
|
|
|
||
|
|
ga.ga_name = "grf";
|
||
|
|
ga.ga_mode = ati_mode;
|
||
|
|
ga.ga_display = &ati_display;
|
||
|
|
|
||
|
|
height = videosize >> 16;
|
||
|
|
|
||
|
|
ati_display.gd_regaddr = (caddr_t)reg[2] + 0x800000 - 0x400;
|
||
|
|
ati_display.gd_regsize = 0x400;
|
||
|
|
ati_display.gd_fbaddr = (caddr_t)reg[2] + 0x400;
|
||
|
|
ati_display.gd_fbsize = videorowbytes * height;
|
||
|
|
ati_display.gd_colors = 1 << videobitdepth;
|
||
|
|
ati_display.gd_planes = videobitdepth;
|
||
|
|
ati_display.gd_fbwidth = videorowbytes * 8 / videobitdepth;
|
||
|
|
ati_display.gd_fbheight = height;
|
||
|
|
ati_display.gd_fbrowbytes = videorowbytes;
|
||
|
|
ati_display.gd_devaddr = (caddr_t)reg[2];
|
||
|
|
ati_display.gd_devsize = reg[4];
|
||
|
|
|
||
|
|
config_found(self, &ga, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
int
|
||
|
|
ati_mode(sc, cmd, aux)
|
||
|
|
struct grf_softc *sc;
|
||
|
|
int cmd;
|
||
|
|
void *aux;
|
||
|
|
{
|
||
|
|
return 0;
|
||
|
|
}
|