1320 lines
32 KiB
C
1320 lines
32 KiB
C
/* $NetBSD: machfb.c,v 1.15 2003/07/14 15:47:25 lukem Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 2002 Bang Jun-Young
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Some code is derived from ATI Rage Pro and Derivatives Programmer's Guide.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: machfb.c,v 1.15 2003/07/14 15:47:25 lukem Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/device.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/callout.h>
|
|
|
|
#ifdef __sparc__
|
|
#include <machine/openfirm.h>
|
|
#endif
|
|
|
|
#include <dev/ic/videomode.h>
|
|
|
|
#include <dev/pci/pcivar.h>
|
|
#include <dev/pci/pcireg.h>
|
|
#include <dev/pci/pcidevs.h>
|
|
#include <dev/pci/pciio.h>
|
|
#include <dev/pci/machfbreg.h>
|
|
|
|
#include <dev/wscons/wsdisplayvar.h>
|
|
#include <dev/wscons/wsconsio.h>
|
|
#include <dev/wsfont/wsfont.h>
|
|
#include <dev/rasops/rasops.h>
|
|
|
|
#define MACH64_REG_SIZE 1024
|
|
#define MACH64_REG_OFF 0x7ffc00
|
|
|
|
#define NBARS 3 /* number of Mach64 PCI BARs */
|
|
|
|
struct vga_bar {
|
|
bus_addr_t vb_base;
|
|
bus_size_t vb_size;
|
|
pcireg_t vb_type;
|
|
int vb_flags;
|
|
};
|
|
|
|
struct mach64_softc {
|
|
struct device sc_dev;
|
|
pci_chipset_tag_t sc_pc;
|
|
pcitag_t sc_pcitag;
|
|
|
|
struct vga_bar sc_bars[NBARS];
|
|
struct vga_bar sc_rom;
|
|
|
|
#define sc_aperbase sc_bars[0].vb_base
|
|
#define sc_apersize sc_bars[0].vb_size
|
|
|
|
#define sc_iobase sc_bars[1].vb_base
|
|
#define sc_iosize sc_bars[1].vb_size
|
|
|
|
#define sc_regbase sc_bars[2].vb_base
|
|
#define sc_regsize sc_bars[2].vb_size
|
|
|
|
bus_space_tag_t sc_regt;
|
|
bus_space_tag_t sc_memt;
|
|
bus_space_handle_t sc_regh;
|
|
bus_space_handle_t sc_memh;
|
|
|
|
size_t memsize;
|
|
int memtype;
|
|
|
|
int has_dsp;
|
|
int bits_per_pixel;
|
|
int max_x, max_y;
|
|
int virt_x, virt_y;
|
|
int color_depth;
|
|
|
|
int mem_freq;
|
|
int ramdac_freq;
|
|
int ref_freq;
|
|
|
|
int ref_div;
|
|
int log2_vclk_post_div;
|
|
int vclk_post_div;
|
|
int vclk_fb_div;
|
|
int mclk_post_div;
|
|
int mclk_fb_div;
|
|
|
|
struct mach64screen *wanted;
|
|
struct mach64screen *active;
|
|
void (*switchcb)(void *, int, int);
|
|
void *switchcbarg;
|
|
struct callout switch_callout;
|
|
LIST_HEAD(, mach64screen) screens;
|
|
const struct wsscreen_descr *currenttype;
|
|
};
|
|
|
|
struct mach64screen {
|
|
struct rasops_info ri;
|
|
LIST_ENTRY(mach64screen) next;
|
|
struct mach64_softc *sc;
|
|
const struct wsscreen_descr *type;
|
|
int active;
|
|
u_int16_t *mem;
|
|
int dispoffset;
|
|
int mindispoffset;
|
|
int maxdispoffset;
|
|
|
|
int cursoron;
|
|
int cursorcol;
|
|
int cursorrow;
|
|
u_int16_t cursortmp;
|
|
};
|
|
|
|
struct mach64_crtcregs {
|
|
u_int32_t h_total_disp;
|
|
u_int32_t h_sync_strt_wid;
|
|
u_int32_t v_total_disp;
|
|
u_int32_t v_sync_strt_wid;
|
|
u_int32_t gen_cntl;
|
|
u_int32_t clock_cntl;
|
|
u_int32_t color_depth;
|
|
u_int32_t dot_clock;
|
|
};
|
|
|
|
struct {
|
|
u_int16_t chip_id;
|
|
u_int32_t ramdac_freq;
|
|
} mach64_info[] = {
|
|
{ PCI_PRODUCT_ATI_MACH64_CT, 135000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_PRO_AGP, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_PRO_AGP1X, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_PRO_PCI_B, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_XL_AGP, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_PRO_PCI_P, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_PRO_PCI_L, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_XL_PCI, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_II, 135000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_IIP, 200000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_IIC_PCI, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_IIC_AGP_B, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_IIC_AGP_P, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_LT_PRO_AGP, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_MOB_M3_PCI, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_MOB_M3_AGP, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_LT, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_LT_PRO_PCI, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_MOBILITY, 230000 },
|
|
{ PCI_PRODUCT_ATI_RAGE_LT_PRO, 230000 },
|
|
{ PCI_PRODUCT_ATI_MACH64_VT, 170000 },
|
|
{ PCI_PRODUCT_ATI_MACH64_VTB, 200000 },
|
|
{ PCI_PRODUCT_ATI_MACH64_VT4, 230000 }
|
|
};
|
|
|
|
static int mach64_chip_id, mach64_chip_rev;
|
|
static struct videomode default_mode;
|
|
static struct mach64screen mach64_console_screen;
|
|
|
|
static char *mach64_memtype_names[] = {
|
|
"(N/A)", "DRAM", "EDO DRAM", "EDO DRAM", "SDRAM", "SGRAM", "WRAM",
|
|
"(unknown type)"
|
|
};
|
|
|
|
struct videomode mach64_modes[] = {
|
|
/* 640x400 @ 70 Hz, 31.5 kHz */
|
|
{ 25175, 640, 664, 760, 800, 400, 409, 411, 450, 0 },
|
|
/* 640x480 @ 72 Hz, 36.5 kHz */
|
|
{ 25175, 640, 664, 760, 800, 480, 491, 493, 525, 0 },
|
|
/* 800x600 @ 72 Hz, 48.0 kHz */
|
|
{ 50000, 800, 856, 976, 1040, 600, 637, 643, 666,
|
|
VID_PHSYNC | VID_PVSYNC },
|
|
/* 1024x768 @ 70 Hz, 56.5 kHz */
|
|
{ 75000, 1024, 1048, 1184, 1328, 768, 771, 777, 806,
|
|
VID_NHSYNC | VID_NVSYNC },
|
|
/* 1152x864 @ 70 Hz, 62.4 kHz */
|
|
{ 92000, 1152, 1208, 1368, 1474, 864, 865, 875, 895, 0 },
|
|
/* 1280x1024 @ 70 Hz, 74.59 kHz */
|
|
{ 126500, 1280, 1312, 1472, 1696, 1024, 1032, 1040, 1068,
|
|
VID_NHSYNC | VID_NVSYNC }
|
|
};
|
|
|
|
/* FIXME values are wrong! */
|
|
const u_char mach64_cmap[16 * 3] = {
|
|
0x00, 0x00, 0x00, /* black */
|
|
0x7f, 0x00, 0x00, /* red */
|
|
0x00, 0x7f, 0x00, /* green */
|
|
0x7f, 0x7f, 0x00, /* brown */
|
|
0x00, 0x00, 0x7f, /* blue */
|
|
0x7f, 0x00, 0x7f, /* magenta */
|
|
0x00, 0x7f, 0x7f, /* cyan */
|
|
0xff, 0xff, 0xff, /* white */
|
|
|
|
0x7f, 0x7f, 0x7f, /* black */
|
|
0xff, 0x00, 0x00, /* red */
|
|
0x00, 0xff, 0x00, /* green */
|
|
0xff, 0xff, 0x00, /* brown */
|
|
0x00, 0x00, 0xff, /* blue */
|
|
0xff, 0x00, 0xff, /* magenta */
|
|
0x00, 0xff, 0xff, /* cyan */
|
|
0xff, 0xff, 0xff, /* white */
|
|
};
|
|
|
|
int mach64_match(struct device *, struct cfdata *, void *);
|
|
void mach64_attach(struct device *, struct device *, void *);
|
|
|
|
CFATTACH_DECL(machfb, sizeof(struct mach64_softc), mach64_match, mach64_attach,
|
|
NULL, NULL);
|
|
|
|
void mach64_init(struct mach64_softc *);
|
|
int mach64_get_memsize(struct mach64_softc *);
|
|
int mach64_get_max_ramdac(struct mach64_softc *);
|
|
void mach64_get_mode(struct mach64_softc *, struct videomode *);
|
|
int mach64_calc_crtcregs(struct mach64_softc *, struct mach64_crtcregs *,
|
|
struct videomode *);
|
|
void mach64_set_crtcregs(struct mach64_softc *, struct mach64_crtcregs *);
|
|
int mach64_modeswitch(struct mach64_softc *, struct videomode *);
|
|
void mach64_set_dsp(struct mach64_softc *);
|
|
void mach64_set_pll(struct mach64_softc *, int);
|
|
void mach64_reset_engine(struct mach64_softc *);
|
|
void mach64_init_engine(struct mach64_softc *);
|
|
void mach64_adjust_frame(struct mach64_softc *, int, int);
|
|
void mach64_init_lut(struct mach64_softc *);
|
|
void mach64_switch_screen(struct mach64_softc *);
|
|
void mach64_init_screen(struct mach64_softc *, struct mach64screen *,
|
|
const struct wsscreen_descr *, int, long *, int);
|
|
void mach64_restore_screen(struct mach64screen *,
|
|
const struct wsscreen_descr *, u_int16_t *);
|
|
int mach64_set_screentype(struct mach64_softc *,
|
|
const struct wsscreen_descr *);
|
|
int mach64_is_console(struct pci_attach_args *);
|
|
|
|
void mach64_cursor(void *, int, int, int);
|
|
int mach64_mapchar(void *, int, u_int *);
|
|
void mach64_putchar(void *, int, int, u_int, long);
|
|
void mach64_copycols(void *, int, int, int, int);
|
|
void mach64_erasecols(void *, int, int, int, long);
|
|
void mach64_copyrows(void *, int, int, int);
|
|
void mach64_eraserows(void *, int, int, long);
|
|
int mach64_allocattr(void *, int, int, int, long *);
|
|
|
|
#if 0
|
|
const struct wsdisplay_emulops mach64_emulops = {
|
|
mach64_cursor,
|
|
mach64_mapchar,
|
|
mach64_putchar,
|
|
mach64_copycols,
|
|
mach64_erasecols,
|
|
mach64_copyrows,
|
|
mach64_eraserows,
|
|
mach64_allocattr,
|
|
};
|
|
#endif
|
|
|
|
struct wsscreen_descr mach64_defaultscreen = {
|
|
"default",
|
|
0, 0,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&default_mode
|
|
}, mach64_80x25_screen = {
|
|
"80x25", 80, 25,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[0]
|
|
}, mach64_80x30_screen = {
|
|
"80x30", 80, 30,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[1]
|
|
}, mach64_80x40_screen = {
|
|
"80x40", 80, 40,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 10,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[0]
|
|
}, mach64_80x50_screen = {
|
|
"80x50", 80, 50,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 8,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[0]
|
|
}, mach64_100x37_screen = {
|
|
"100x37", 100, 37,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[2]
|
|
}, mach64_128x48_screen = {
|
|
"128x48", 128, 48,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[3]
|
|
}, mach64_144x54_screen = {
|
|
"144x54", 144, 54,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[4]
|
|
}, mach64_160x64_screen = {
|
|
"160x54", 160, 64,
|
|
&mach64_console_screen.ri.ri_ops,
|
|
8, 16,
|
|
WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
|
|
&mach64_modes[5]
|
|
};
|
|
|
|
const struct wsscreen_descr *_mach64_scrlist[] = {
|
|
&mach64_defaultscreen,
|
|
&mach64_80x25_screen,
|
|
&mach64_80x30_screen,
|
|
&mach64_80x40_screen,
|
|
&mach64_80x50_screen,
|
|
&mach64_100x37_screen,
|
|
&mach64_128x48_screen,
|
|
&mach64_144x54_screen,
|
|
&mach64_160x64_screen
|
|
};
|
|
|
|
struct wsscreen_list mach64_screenlist = {
|
|
sizeof(_mach64_scrlist) / sizeof(struct wsscreen_descr *),
|
|
_mach64_scrlist
|
|
};
|
|
|
|
int mach64_ioctl(void *, u_long, caddr_t, int, struct proc *);
|
|
paddr_t mach64_mmap(void *, off_t, int);
|
|
int mach64_alloc_screen(void *, const struct wsscreen_descr *, void **,
|
|
int *, int *, long *);
|
|
void mach64_free_screen(void *, void *);
|
|
int mach64_show_screen(void *, void *, int, void (*)(void *, int, int),
|
|
void *);
|
|
int mach64_load_font(void *, void *, struct wsdisplay_font *);
|
|
|
|
struct wsdisplay_accessops mach64_accessops = {
|
|
mach64_ioctl,
|
|
mach64_mmap,
|
|
mach64_alloc_screen,
|
|
mach64_free_screen,
|
|
mach64_show_screen,
|
|
NULL
|
|
};
|
|
|
|
/*
|
|
* Inline functions for getting access to register aperture.
|
|
*/
|
|
static inline u_int32_t regr(struct mach64_softc *, u_int32_t);
|
|
static inline u_int8_t regrb(struct mach64_softc *, u_int32_t);
|
|
static inline void regw(struct mach64_softc *, u_int32_t, u_int32_t);
|
|
static inline void regwb(struct mach64_softc *, u_int32_t, u_int8_t);
|
|
static inline void regwb_pll(struct mach64_softc *, u_int32_t, u_int8_t);
|
|
|
|
static inline u_int32_t
|
|
regr(struct mach64_softc *sc, u_int32_t index)
|
|
{
|
|
|
|
return bus_space_read_4(sc->sc_regt, sc->sc_regh, index);
|
|
}
|
|
|
|
static inline u_int8_t
|
|
regrb(struct mach64_softc *sc, u_int32_t index)
|
|
{
|
|
|
|
return bus_space_read_1(sc->sc_regt, sc->sc_regh, index);
|
|
}
|
|
|
|
static inline void
|
|
regw(struct mach64_softc *sc, u_int32_t index, u_int32_t data)
|
|
{
|
|
|
|
bus_space_write_4(sc->sc_regt, sc->sc_regh, index, data);
|
|
}
|
|
|
|
static inline void
|
|
regwb(struct mach64_softc *sc, u_int32_t index, u_int8_t data)
|
|
{
|
|
|
|
bus_space_write_1(sc->sc_regt, sc->sc_regh, index, data);
|
|
}
|
|
|
|
static inline void
|
|
regwb_pll(struct mach64_softc *sc, u_int32_t index, u_int8_t data)
|
|
{
|
|
|
|
regwb(sc, CLOCK_CNTL + 1, (index << 2) | PLL_WR_EN);
|
|
regwb(sc, CLOCK_CNTL + 2, data);
|
|
regwb(sc, CLOCK_CNTL + 1, (index << 2) & ~PLL_WR_EN);
|
|
}
|
|
|
|
static inline void
|
|
wait_for_fifo(struct mach64_softc *sc, u_int8_t v)
|
|
{
|
|
|
|
while ((regr(sc, FIFO_STAT) & 0xffff) > (0x8000 >> v))
|
|
;
|
|
}
|
|
|
|
static inline void
|
|
wait_for_idle(struct mach64_softc *sc)
|
|
{
|
|
|
|
wait_for_fifo(sc, 16);
|
|
while ((regr(sc, GUI_STAT) & 1) != 0)
|
|
;
|
|
}
|
|
|
|
int
|
|
mach64_match(struct device *parent, struct cfdata *match, void *aux)
|
|
{
|
|
struct pci_attach_args *pa = (struct pci_attach_args *)aux;
|
|
int i;
|
|
|
|
if (PCI_CLASS(pa->pa_class) != PCI_CLASS_DISPLAY ||
|
|
PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_DISPLAY_VGA)
|
|
return 0;
|
|
|
|
for (i = 0; i < sizeof(mach64_info) / sizeof(mach64_info[0]); i++)
|
|
if (PCI_PRODUCT(pa->pa_id) == mach64_info[i].chip_id) {
|
|
mach64_chip_id = PCI_PRODUCT(pa->pa_id);
|
|
mach64_chip_rev = PCI_REVISION(pa->pa_class);
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
mach64_attach(struct device *parent, struct device *self, void *aux)
|
|
{
|
|
struct mach64_softc *sc = (void *)self;
|
|
struct pci_attach_args *pa = aux;
|
|
char devinfo[256];
|
|
int bar, reg, id;
|
|
struct wsemuldisplaydev_attach_args aa;
|
|
long defattr;
|
|
int setmode, console;
|
|
|
|
sc->sc_pc = pa->pa_pc;
|
|
sc->sc_pcitag = pa->pa_tag;
|
|
|
|
pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo);
|
|
printf(": %s (rev. 0x%02x)\n", devinfo, PCI_REVISION(pa->pa_class));
|
|
|
|
for (bar = 0; bar < NBARS; bar++) {
|
|
reg = PCI_MAPREG_START + (bar * 4);
|
|
sc->sc_bars[bar].vb_type = pci_mapreg_type(sc->sc_pc,
|
|
sc->sc_pcitag, reg);
|
|
(void)pci_mapreg_info(sc->sc_pc, sc->sc_pcitag, reg,
|
|
sc->sc_bars[bar].vb_type, &sc->sc_bars[bar].vb_base,
|
|
&sc->sc_bars[bar].vb_size, &sc->sc_bars[bar].vb_flags);
|
|
}
|
|
sc->sc_memt = pa->pa_memt;
|
|
|
|
mach64_init(sc);
|
|
|
|
printf("%s: %d MB aperture at 0x%08x, %d KB registers at 0x%08x\n",
|
|
sc->sc_dev.dv_xname, (u_int)(sc->sc_apersize / (1024 * 1024)),
|
|
(u_int)sc->sc_aperbase, (u_int)(sc->sc_regsize / 1024),
|
|
(u_int)sc->sc_regbase);
|
|
|
|
if (mach64_chip_id == PCI_PRODUCT_ATI_MACH64_CT ||
|
|
((mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II) &&
|
|
(mach64_chip_rev & 0x07) == 0))
|
|
sc->has_dsp = 0;
|
|
else
|
|
sc->has_dsp = 1;
|
|
|
|
sc->memsize = mach64_get_memsize(sc);
|
|
if (sc->memsize == 8192)
|
|
/* The last page is used as register aperture. */
|
|
sc->memsize -= 4;
|
|
sc->memtype = regr(sc, CONFIG_STAT0) & 0x07;
|
|
|
|
/* XXX is there any way to calculate reference frequency from
|
|
known values? */
|
|
if (mach64_chip_id == PCI_PRODUCT_ATI_RAGE_XL_PCI)
|
|
sc->ref_freq = 29498;
|
|
else
|
|
sc->ref_freq = 14318;
|
|
|
|
regwb(sc, CLOCK_CNTL + 1, PLL_REF_DIV << 2);
|
|
sc->ref_div = regrb(sc, CLOCK_CNTL + 2);
|
|
regwb(sc, CLOCK_CNTL + 1, MCLK_FB_DIV << 2);
|
|
sc->mclk_fb_div = regrb(sc, CLOCK_CNTL + 2);
|
|
sc->mem_freq = (2 * sc->ref_freq * sc->mclk_fb_div) /
|
|
(sc->ref_div * 2);
|
|
sc->mclk_post_div = (sc->mclk_fb_div * 2 * sc->ref_freq) /
|
|
(sc->mem_freq * sc->ref_div);
|
|
sc->ramdac_freq = mach64_get_max_ramdac(sc);
|
|
printf("%s: %ld KB %s %d.%d MHz, maximum RAMDAC clock %d MHz\n",
|
|
sc->sc_dev.dv_xname, (u_long)sc->memsize,
|
|
mach64_memtype_names[sc->memtype],
|
|
sc->mem_freq / 1000, sc->mem_freq % 1000,
|
|
sc->ramdac_freq / 1000);
|
|
|
|
id = regr(sc, CONFIG_CHIP_ID) & 0xffff;
|
|
if (id != mach64_chip_id) {
|
|
printf("%s: chip ID mismatch, 0x%x != 0x%x\n",
|
|
sc->sc_dev.dv_xname, id, mach64_chip_id);
|
|
return;
|
|
}
|
|
|
|
console = mach64_is_console(pa);
|
|
|
|
#ifdef __sparc__
|
|
if (console) {
|
|
mach64_get_mode(sc, &default_mode);
|
|
setmode = 0;
|
|
} else {
|
|
memcpy(&default_mode, &mach64_modes[4], sizeof(struct videomode));
|
|
setmode = 1;
|
|
}
|
|
#else
|
|
memcpy(&default_mode, &mach64_modes[0], sizeof(struct videomode));
|
|
setmode = 1;
|
|
#endif
|
|
|
|
sc->bits_per_pixel = 8;
|
|
sc->virt_x = default_mode.hdisplay;
|
|
sc->virt_y = default_mode.vdisplay;
|
|
sc->max_x = sc->virt_x - 1;
|
|
sc->max_y = (sc->memsize * 1024) /
|
|
(sc->virt_x * (sc->bits_per_pixel / 8)) - 1;
|
|
|
|
sc->color_depth = CRTC_PIX_WIDTH_8BPP;
|
|
|
|
mach64_init_engine(sc);
|
|
#if 0
|
|
mach64_adjust_frame(0, 0);
|
|
if (sc->bits_per_pixel == 8)
|
|
mach64_init_lut(sc);
|
|
#endif
|
|
|
|
printf("%s: initial resolution %dx%d at %d bpp\n", sc->sc_dev.dv_xname,
|
|
default_mode.hdisplay, default_mode.vdisplay,
|
|
sc->bits_per_pixel);
|
|
|
|
mach64_console_screen.ri.ri_hw = sc;
|
|
mach64_console_screen.ri.ri_depth = sc->bits_per_pixel;
|
|
mach64_console_screen.ri.ri_bits = (void*)(u_long)sc->sc_aperbase;
|
|
mach64_console_screen.ri.ri_width = default_mode.hdisplay;
|
|
mach64_console_screen.ri.ri_height = default_mode.vdisplay;
|
|
mach64_console_screen.ri.ri_stride = mach64_console_screen.ri.ri_width;
|
|
mach64_console_screen.ri.ri_flg = RI_CLEAR;
|
|
|
|
rasops_init(&mach64_console_screen.ri, mach64_console_screen.ri.ri_height / 16,
|
|
mach64_console_screen.ri.ri_width / 8);
|
|
|
|
mach64_defaultscreen.nrows = mach64_console_screen.ri.ri_rows;
|
|
mach64_defaultscreen.ncols = mach64_console_screen.ri.ri_cols;
|
|
|
|
mach64_console_screen.ri.ri_ops.allocattr(&mach64_console_screen.ri, 0, 0, 0,
|
|
&defattr);
|
|
|
|
/* Initialize fonts */
|
|
wsfont_init();
|
|
|
|
if (console) {
|
|
mach64_init_screen(sc, &mach64_console_screen,
|
|
&mach64_defaultscreen, 1, &defattr, setmode);
|
|
wsdisplay_cnattach(&mach64_defaultscreen, &mach64_console_screen.ri,
|
|
0, 0, defattr);
|
|
}
|
|
|
|
aa.console = console;
|
|
aa.scrdata = &mach64_screenlist;
|
|
aa.accessops = &mach64_accessops;
|
|
aa.accesscookie = sc;
|
|
|
|
config_found(self, &aa, wsemuldisplaydevprint);
|
|
}
|
|
|
|
void
|
|
mach64_init_screen(struct mach64_softc *sc, struct mach64screen *scr,
|
|
const struct wsscreen_descr *type, int existing, long *attrp, int setmode)
|
|
{
|
|
|
|
scr->sc = sc;
|
|
scr->type = type;
|
|
scr->mindispoffset = 0;
|
|
scr->maxdispoffset = sc->memsize * 1024;
|
|
scr->dispoffset = 0;
|
|
scr->cursorcol = 0;
|
|
scr->cursorrow = 0;
|
|
|
|
scr->mem = (u_int16_t *)malloc(type->nrows * type->ncols * 2,
|
|
M_DEVBUF, M_WAITOK);
|
|
if (existing) {
|
|
scr->active = 1;
|
|
|
|
if (setmode && mach64_set_screentype(sc, type)) {
|
|
panic("%s: failed to switch video mode",
|
|
sc->sc_dev.dv_xname);
|
|
}
|
|
} else {
|
|
scr->active = 0;
|
|
}
|
|
|
|
LIST_INSERT_HEAD(&sc->screens, scr, next);
|
|
}
|
|
|
|
void
|
|
mach64_init(struct mach64_softc *sc)
|
|
{
|
|
u_int32_t *p32, saved_value;
|
|
u_int8_t *p;
|
|
int need_swap;
|
|
|
|
if (bus_space_map(sc->sc_memt, sc->sc_aperbase, sc->sc_apersize,
|
|
BUS_SPACE_MAP_LINEAR, &sc->sc_memh)) {
|
|
panic("%s: failed to map aperture", sc->sc_dev.dv_xname);
|
|
}
|
|
sc->sc_aperbase = (vaddr_t)bus_space_vaddr(sc->sc_memt, sc->sc_memh);
|
|
|
|
sc->sc_regt = sc->sc_memt;
|
|
bus_space_subregion(sc->sc_regt, sc->sc_memh, MACH64_REG_OFF,
|
|
sc->sc_regsize, &sc->sc_regh);
|
|
sc->sc_regbase = sc->sc_aperbase + 0x7ffc00;
|
|
|
|
/*
|
|
* Test wether the aperture is byte swapped or not
|
|
*/
|
|
p32 = (u_int32_t*)(u_long)sc->sc_aperbase;
|
|
saved_value = *p32;
|
|
p = (u_int8_t*)(u_long)sc->sc_aperbase;
|
|
*p32 = 0x12345678;
|
|
if (p[0] == 0x12 && p[1] == 0x34 && p[2] == 0x56 && p[3] == 0x78)
|
|
need_swap = 0;
|
|
else
|
|
need_swap = 1;
|
|
if (need_swap) {
|
|
sc->sc_aperbase += 0x800000;
|
|
sc->sc_apersize -= 0x800000;
|
|
}
|
|
*p32 = saved_value;
|
|
|
|
LIST_INIT(&sc->screens);
|
|
sc->active = NULL;
|
|
sc->currenttype = &mach64_defaultscreen;
|
|
callout_init(&sc->switch_callout);
|
|
}
|
|
|
|
int
|
|
mach64_get_memsize(struct mach64_softc *sc)
|
|
{
|
|
int tmp, memsize;
|
|
int mem_tab[] = {
|
|
512, 1024, 2048, 4096, 6144, 8192, 12288, 16384
|
|
};
|
|
|
|
tmp = regr(sc, MEM_CNTL);
|
|
if (sc->has_dsp) {
|
|
tmp &= 0x0000000f;
|
|
if (tmp < 8)
|
|
memsize = (tmp + 1) * 512;
|
|
else if (tmp < 12)
|
|
memsize = (tmp - 3) * 1024;
|
|
else
|
|
memsize = (tmp - 7) * 2048;
|
|
} else {
|
|
memsize = mem_tab[tmp & 0x07];
|
|
}
|
|
|
|
return memsize;
|
|
}
|
|
|
|
int
|
|
mach64_get_max_ramdac(struct mach64_softc *sc)
|
|
{
|
|
int i;
|
|
|
|
if ((mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II) &&
|
|
(mach64_chip_rev & 0x07))
|
|
return 170000;
|
|
|
|
for (i = 0; i < sizeof(mach64_info) / sizeof(mach64_info[0]); i++)
|
|
if (mach64_chip_id == mach64_info[i].chip_id)
|
|
return mach64_info[i].ramdac_freq;
|
|
|
|
if (sc->bits_per_pixel == 8)
|
|
return 135000;
|
|
else
|
|
return 80000;
|
|
}
|
|
|
|
void
|
|
mach64_get_mode(struct mach64_softc *sc, struct videomode *mode)
|
|
{
|
|
struct mach64_crtcregs crtc;
|
|
|
|
crtc.h_total_disp = regr(sc, CRTC_H_TOTAL_DISP);
|
|
crtc.h_sync_strt_wid = regr(sc, CRTC_H_SYNC_STRT_WID);
|
|
crtc.v_total_disp = regr(sc, CRTC_V_TOTAL_DISP);
|
|
crtc.v_sync_strt_wid = regr(sc, CRTC_V_SYNC_STRT_WID);
|
|
|
|
mode->htotal = ((crtc.h_total_disp & 0xffff) + 1) << 3;
|
|
mode->hdisplay = ((crtc.h_total_disp >> 16) + 1) << 3;
|
|
mode->hsync_start = ((crtc.h_sync_strt_wid & 0xffff) + 1) << 3;
|
|
mode->hsync_end = ((crtc.h_sync_strt_wid >> 16) << 3) +
|
|
mode->hsync_start;
|
|
mode->vtotal = (crtc.v_total_disp & 0xffff) + 1;
|
|
mode->vdisplay = (crtc.v_total_disp >> 16) + 1;
|
|
mode->vsync_start = (crtc.v_sync_strt_wid & 0xffff) + 1;
|
|
mode->vsync_end = (crtc.v_sync_strt_wid >> 16) + mode->vsync_start;
|
|
|
|
#ifdef MACH64_DEBUG
|
|
printf("mach64_get_mode: %d %d %d %d %d %d %d %d\n",
|
|
mode->hdisplay, mode->hsync_start, mode->hsync_end, mode->htotal,
|
|
mode->vdisplay, mode->vsync_start, mode->vsync_end, mode->vtotal);
|
|
#endif
|
|
}
|
|
|
|
int
|
|
mach64_calc_crtcregs(struct mach64_softc *sc, struct mach64_crtcregs *crtc,
|
|
struct videomode *mode)
|
|
{
|
|
|
|
if (mode->dot_clock > sc->ramdac_freq)
|
|
/* Clock too high. */
|
|
return 1;
|
|
|
|
crtc->h_total_disp = (((mode->hdisplay >> 3) - 1) << 16) |
|
|
((mode->htotal >> 3) - 1);
|
|
crtc->h_sync_strt_wid =
|
|
(((mode->hsync_end - mode->hsync_start) >> 3) << 16) |
|
|
((mode->hsync_start >> 3) - 1);
|
|
|
|
crtc->v_total_disp = ((mode->vdisplay - 1) << 16) |
|
|
(mode->vtotal - 1);
|
|
crtc->v_sync_strt_wid =
|
|
((mode->vsync_end - mode->vsync_start) << 16) |
|
|
(mode->vsync_start - 1);
|
|
|
|
if (mode->flags & VID_NVSYNC)
|
|
crtc->v_sync_strt_wid |= CRTC_VSYNC_NEG;
|
|
|
|
switch (sc->bits_per_pixel) {
|
|
case 8:
|
|
crtc->color_depth = CRTC_PIX_WIDTH_8BPP;
|
|
break;
|
|
case 16:
|
|
crtc->color_depth = CRTC_PIX_WIDTH_16BPP;
|
|
break;
|
|
case 32:
|
|
crtc->color_depth = CRTC_PIX_WIDTH_32BPP;
|
|
break;
|
|
}
|
|
|
|
crtc->gen_cntl = 0;
|
|
if (mode->flags & VID_INTERLACE)
|
|
crtc->gen_cntl |= CRTC_INTERLACE_EN;
|
|
if (mode->flags & VID_CSYNC)
|
|
crtc->gen_cntl |= CRTC_CSYNC_EN;
|
|
|
|
crtc->dot_clock = mode->dot_clock;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
mach64_set_crtcregs(struct mach64_softc *sc, struct mach64_crtcregs *crtc)
|
|
{
|
|
|
|
mach64_set_pll(sc, crtc->dot_clock);
|
|
|
|
if (sc->has_dsp)
|
|
mach64_set_dsp(sc);
|
|
|
|
regw(sc, CRTC_H_TOTAL_DISP, crtc->h_total_disp);
|
|
regw(sc, CRTC_H_SYNC_STRT_WID, crtc->h_sync_strt_wid);
|
|
regw(sc, CRTC_V_TOTAL_DISP, crtc->v_total_disp);
|
|
regw(sc, CRTC_V_SYNC_STRT_WID, crtc->v_sync_strt_wid);
|
|
|
|
regw(sc, CRTC_VLINE_CRNT_VLINE, 0);
|
|
|
|
regw(sc, CRTC_OFF_PITCH, (sc->virt_x >> 3) << 22);
|
|
|
|
regw(sc, CRTC_GEN_CNTL, crtc->gen_cntl | crtc->color_depth |
|
|
CRTC_EXT_DISP_EN | CRTC_EXT_EN);
|
|
}
|
|
|
|
int
|
|
mach64_modeswitch(struct mach64_softc *sc, struct videomode *mode)
|
|
{
|
|
struct mach64_crtcregs crtc;
|
|
|
|
if (mach64_calc_crtcregs(sc, &crtc, mode))
|
|
return 1;
|
|
|
|
mach64_set_crtcregs(sc, &crtc);
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
mach64_reset_engine(struct mach64_softc *sc)
|
|
{
|
|
|
|
/* Reset engine.*/
|
|
regw(sc, GEN_TEST_CNTL, regr(sc, GEN_TEST_CNTL) & ~GUI_ENGINE_ENABLE);
|
|
|
|
/* Enable engine. */
|
|
regw(sc, GEN_TEST_CNTL, regr(sc, GEN_TEST_CNTL) | GUI_ENGINE_ENABLE);
|
|
|
|
/* Ensure engine is not locked up by clearing any FIFO or
|
|
host errors. */
|
|
regw(sc, BUS_CNTL, regr(sc, BUS_CNTL) | BUS_HOST_ERR_ACK |
|
|
BUS_FIFO_ERR_ACK);
|
|
}
|
|
|
|
void
|
|
mach64_init_engine(struct mach64_softc *sc)
|
|
{
|
|
u_int32_t pitch_value;
|
|
|
|
pitch_value = sc->virt_x;
|
|
|
|
if (sc->bits_per_pixel == 24)
|
|
pitch_value *= 3;
|
|
|
|
mach64_reset_engine(sc);
|
|
|
|
wait_for_fifo(sc, 14);
|
|
|
|
regw(sc, CONTEXT_MASK, 0xffffffff);
|
|
|
|
regw(sc, DST_OFF_PITCH, (pitch_value / 8) << 22);
|
|
|
|
regw(sc, DST_Y_X, 0);
|
|
regw(sc, DST_HEIGHT, 0);
|
|
regw(sc, DST_BRES_ERR, 0);
|
|
regw(sc, DST_BRES_INC, 0);
|
|
regw(sc, DST_BRES_DEC, 0);
|
|
|
|
regw(sc, DST_CNTL, DST_LAST_PEL | DST_X_LEFT_TO_RIGHT |
|
|
DST_Y_TOP_TO_BOTTOM);
|
|
|
|
regw(sc, SRC_OFF_PITCH, (pitch_value / 8) << 22);
|
|
|
|
regw(sc, SRC_Y_X, 0);
|
|
regw(sc, SRC_HEIGHT1_WIDTH1, 1);
|
|
regw(sc, SRC_Y_X_START, 0);
|
|
regw(sc, SRC_HEIGHT2_WIDTH2, 1);
|
|
|
|
regw(sc, SRC_CNTL, SRC_LINE_X_LEFT_TO_RIGHT);
|
|
|
|
wait_for_fifo(sc, 13);
|
|
regw(sc, HOST_CNTL, 0);
|
|
|
|
regw(sc, PAT_REG0, 0);
|
|
regw(sc, PAT_REG1, 0);
|
|
regw(sc, PAT_CNTL, 0);
|
|
|
|
regw(sc, SC_LEFT, 0);
|
|
regw(sc, SC_TOP, 0);
|
|
regw(sc, SC_BOTTOM, default_mode.vdisplay - 1);
|
|
regw(sc, SC_RIGHT, pitch_value - 1);
|
|
|
|
regw(sc, DP_BKGD_CLR, 0);
|
|
regw(sc, DP_FRGD_CLR, 0xffffffff);
|
|
regw(sc, DP_WRITE_MASK, 0xffffffff);
|
|
regw(sc, DP_MIX, (MIX_SRC << 16) | MIX_DST);
|
|
|
|
regw(sc, DP_SRC, FRGD_SRC_FRGD_CLR);
|
|
|
|
wait_for_fifo(sc, 3);
|
|
regw(sc, CLR_CMP_CLR, 0);
|
|
regw(sc, CLR_CMP_MASK, 0xffffffff);
|
|
regw(sc, CLR_CMP_CNTL, 0);
|
|
|
|
wait_for_fifo(sc, 2);
|
|
switch (sc->bits_per_pixel) {
|
|
case 8:
|
|
regw(sc, DP_PIX_WIDTH, HOST_8BPP | SRC_8BPP | DST_8BPP);
|
|
regw(sc, DP_CHAIN_MASK, DP_CHAIN_8BPP);
|
|
regw(sc, DAC_CNTL, regr(sc, DAC_CNTL) & ~DAC_8BIT_EN);
|
|
break;
|
|
#if 0
|
|
case 32:
|
|
regw(sc, DP_PIX_WIDTH, HOST_32BPP | SRC_32BPP | DST_32BPP);
|
|
regw(sc, DP_CHAIN_MASK, DP_CHAIN_32BPP);
|
|
regw(sc, DAC_CNTL, regr(sc, DAC_CNTL) | DAC_8BIT_EN);
|
|
break;
|
|
#endif
|
|
}
|
|
|
|
wait_for_fifo(sc, 5);
|
|
regw(sc, CRTC_INT_CNTL, regr(sc, CRTC_INT_CNTL) & ~0x20);
|
|
regw(sc, GUI_TRAJ_CNTL, DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM);
|
|
|
|
wait_for_idle(sc);
|
|
}
|
|
|
|
void
|
|
mach64_adjust_frame(struct mach64_softc *sc, int x, int y)
|
|
{
|
|
int offset;
|
|
|
|
offset = ((x + y * sc->virt_x) * (sc->bits_per_pixel >> 3)) >> 3;
|
|
|
|
regw(sc, CRTC_OFF_PITCH, (regr(sc, CRTC_OFF_PITCH) & 0xfff00000) |
|
|
offset);
|
|
}
|
|
|
|
void
|
|
mach64_set_dsp(struct mach64_softc *sc)
|
|
{
|
|
u_int32_t fifo_depth, page_size, dsp_precision, dsp_loop_latency;
|
|
u_int32_t dsp_off, dsp_on, dsp_xclks_per_qw;
|
|
u_int32_t xclks_per_qw, y;
|
|
u_int32_t fifo_off, fifo_on;
|
|
|
|
if (mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIP ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_PCI ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_AGP_B ||
|
|
mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_AGP_P) {
|
|
dsp_loop_latency = 0;
|
|
fifo_depth = 24;
|
|
} else {
|
|
dsp_loop_latency = 2;
|
|
fifo_depth = 32;
|
|
}
|
|
|
|
dsp_precision = 0;
|
|
xclks_per_qw = (sc->mclk_fb_div * sc->vclk_post_div * 64 << 11) /
|
|
(sc->vclk_fb_div * sc->mclk_post_div * sc->bits_per_pixel);
|
|
y = (xclks_per_qw * fifo_depth) >> 11;
|
|
while (y) {
|
|
y >>= 1;
|
|
dsp_precision++;
|
|
}
|
|
dsp_precision -= 5;
|
|
fifo_off = ((xclks_per_qw * (fifo_depth - 1)) >> 5) + (3 << 6);
|
|
|
|
switch (sc->memtype) {
|
|
case DRAM:
|
|
case EDO_DRAM:
|
|
case PSEUDO_EDO:
|
|
if (sc->memsize > 1024) {
|
|
page_size = 9;
|
|
dsp_loop_latency += 6;
|
|
} else {
|
|
page_size = 10;
|
|
if (sc->memtype == DRAM)
|
|
dsp_loop_latency += 8;
|
|
else
|
|
dsp_loop_latency += 7;
|
|
}
|
|
break;
|
|
case SDRAM:
|
|
case SGRAM:
|
|
if (sc->memsize > 1024) {
|
|
page_size = 8;
|
|
dsp_loop_latency += 8;
|
|
} else {
|
|
page_size = 10;
|
|
dsp_loop_latency += 9;
|
|
}
|
|
break;
|
|
default:
|
|
page_size = 10;
|
|
dsp_loop_latency += 9;
|
|
break;
|
|
}
|
|
|
|
if (xclks_per_qw >= (page_size << 11))
|
|
fifo_on = ((2 * page_size + 1) << 6) + (xclks_per_qw >> 5);
|
|
else
|
|
fifo_on = (3 * page_size + 2) << 6;
|
|
|
|
dsp_xclks_per_qw = xclks_per_qw >> dsp_precision;
|
|
dsp_on = fifo_on >> dsp_precision;
|
|
dsp_off = fifo_off >> dsp_precision;
|
|
|
|
#ifdef MACH64_DEBUG
|
|
printf("dsp_xclks_per_qw = %d, dsp_on = %d, dsp_off = %d,\n"
|
|
"dsp_precision = %d, dsp_loop_latency = %d,\n"
|
|
"mclk_fb_div = %d, vclk_fb_div = %d,\n"
|
|
"mclk_post_div = %d, vclk_post_div = %d\n",
|
|
dsp_xclks_per_qw, dsp_on, dsp_off, dsp_precision, dsp_loop_latency,
|
|
sc->mclk_fb_div, sc->vclk_fb_div,
|
|
sc->mclk_post_div, sc->vclk_post_div);
|
|
#endif
|
|
|
|
regw(sc, DSP_ON_OFF, ((dsp_on << 16) & DSP_ON) | (dsp_off & DSP_OFF));
|
|
regw(sc, DSP_CONFIG, ((dsp_precision << 20) & DSP_PRECISION) |
|
|
((dsp_loop_latency << 16) & DSP_LOOP_LATENCY) |
|
|
(dsp_xclks_per_qw & DSP_XCLKS_PER_QW));
|
|
}
|
|
|
|
void
|
|
mach64_set_pll(struct mach64_softc *sc, int clock)
|
|
{
|
|
int q;
|
|
|
|
q = (clock * sc->ref_div * 100) / (2 * sc->ref_freq);
|
|
#ifdef MACH64_DEBUG
|
|
printf("q = %d\n", q);
|
|
#endif
|
|
if (q > 25500) {
|
|
printf("Warning: q > 25500\n");
|
|
q = 25500;
|
|
sc->vclk_post_div = 1;
|
|
sc->log2_vclk_post_div = 0;
|
|
} else if (q > 12750) {
|
|
sc->vclk_post_div = 1;
|
|
sc->log2_vclk_post_div = 0;
|
|
} else if (q > 6350) {
|
|
sc->vclk_post_div = 2;
|
|
sc->log2_vclk_post_div = 1;
|
|
} else if (q > 3150) {
|
|
sc->vclk_post_div = 4;
|
|
sc->log2_vclk_post_div = 2;
|
|
} else if (q >= 1600) {
|
|
sc->vclk_post_div = 8;
|
|
sc->log2_vclk_post_div = 3;
|
|
} else {
|
|
printf("Warning: q < 1600\n");
|
|
sc->vclk_post_div = 8;
|
|
sc->log2_vclk_post_div = 3;
|
|
}
|
|
sc->vclk_fb_div = q * sc->vclk_post_div / 100;
|
|
|
|
regwb_pll(sc, MCLK_FB_DIV, sc->mclk_fb_div);
|
|
regwb_pll(sc, VCLK_POST_DIV, sc->log2_vclk_post_div);
|
|
regwb_pll(sc, VCLK0_FB_DIV, sc->vclk_fb_div);
|
|
}
|
|
|
|
void
|
|
mach64_init_lut(struct mach64_softc *sc)
|
|
{
|
|
int i;
|
|
|
|
regwb(sc, DAC_REGS, 0);
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
regwb(sc, DAC_REGS + 1, mach64_cmap[i * 3]);
|
|
regwb(sc, DAC_REGS + 1, mach64_cmap[i * 3 + 1]);
|
|
regwb(sc, DAC_REGS + 1, mach64_cmap[i + 3 + 2]);
|
|
}
|
|
}
|
|
|
|
void
|
|
mach64_switch_screen(struct mach64_softc *sc)
|
|
{
|
|
struct mach64screen *scr, *oldscr;
|
|
const struct wsscreen_descr *type;
|
|
|
|
scr = sc->wanted;
|
|
if (!scr) {
|
|
printf("mach64_switch_screen: disappeared\n");
|
|
(*sc->switchcb)(sc->switchcbarg, EIO, 0);
|
|
return;
|
|
}
|
|
type = scr->type;
|
|
oldscr = sc->active; /* can be NULL! */
|
|
#ifdef DIAGNOSTIC
|
|
if (oldscr) {
|
|
if (!oldscr->active)
|
|
panic("mach64_switch_screen: not active");
|
|
if (oldscr->type != sc->currenttype)
|
|
panic("mach64_switch_screen: bad type");
|
|
}
|
|
#endif
|
|
if (scr == oldscr)
|
|
return;
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (scr->active)
|
|
panic("mach64_switch_screen: active");
|
|
#endif
|
|
|
|
if (oldscr)
|
|
oldscr->active = 0;
|
|
|
|
if (sc->currenttype != type) {
|
|
mach64_set_screentype(sc, type);
|
|
sc->currenttype = type;
|
|
}
|
|
|
|
scr->dispoffset = scr->mindispoffset;
|
|
|
|
if (!oldscr || (scr->dispoffset != oldscr->dispoffset)) {
|
|
|
|
}
|
|
|
|
/* Clear the entire screen. */
|
|
|
|
scr->active = 1;
|
|
mach64_restore_screen(scr, type, scr->mem);
|
|
|
|
sc->active = scr;
|
|
|
|
mach64_cursor(scr, scr->cursoron, scr->cursorrow, scr->cursorcol);
|
|
|
|
sc->wanted = 0;
|
|
if (sc->switchcb)
|
|
(*sc->switchcb)(sc->switchcbarg, 0, 0);
|
|
}
|
|
|
|
void
|
|
mach64_restore_screen(struct mach64screen *scr,
|
|
const struct wsscreen_descr *type, u_int16_t *mem)
|
|
{
|
|
|
|
}
|
|
|
|
int
|
|
mach64_set_screentype(struct mach64_softc *sc, const struct wsscreen_descr *des)
|
|
{
|
|
struct mach64_crtcregs regs;
|
|
|
|
if (mach64_calc_crtcregs(sc, ®s,
|
|
(struct videomode *)des->modecookie))
|
|
return 1;
|
|
|
|
mach64_set_crtcregs(sc, ®s);
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
mach64_is_console(struct pci_attach_args *pa)
|
|
{
|
|
#ifdef __sparc__
|
|
int node;
|
|
|
|
node = PCITAG_NODE(pa->pa_tag);
|
|
if (node == -1)
|
|
return 0;
|
|
|
|
return (node == OF_instance_to_package(OF_stdout()));
|
|
#else
|
|
return 1;
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* wsdisplay_emulops
|
|
*/
|
|
|
|
void
|
|
mach64_cursor(void *cookie, int on, int row, int col)
|
|
{
|
|
|
|
}
|
|
|
|
#if 0
|
|
int
|
|
mach64_mapchar(void *cookie, int uni, u_int *index)
|
|
{
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
mach64_putchar(void *cookie, int row, int col, u_int c, long attr)
|
|
{
|
|
|
|
}
|
|
|
|
void
|
|
mach64_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
|
|
{
|
|
|
|
}
|
|
|
|
void
|
|
mach64_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
|
|
{
|
|
|
|
}
|
|
|
|
void
|
|
mach64_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
|
|
{
|
|
|
|
}
|
|
|
|
int
|
|
mach64_allocattr(void *cookie, int fg, int bg, int flags, long *attrp)
|
|
{
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
void
|
|
mach64_eraserows(void *cookie, int row, int nrows, long fillattr)
|
|
{
|
|
|
|
}
|
|
|
|
/*
|
|
* wsdisplay_accessops
|
|
*/
|
|
|
|
int
|
|
mach64_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
|
|
{
|
|
|
|
return ENOTTY;
|
|
}
|
|
|
|
paddr_t
|
|
mach64_mmap(void *v, off_t offset, int prot)
|
|
{
|
|
|
|
return -1;
|
|
}
|
|
|
|
int
|
|
mach64_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
|
|
int *curxp, int *curyp, long *defattrp)
|
|
{
|
|
struct mach64_softc *sc = v;
|
|
struct mach64screen *scr;
|
|
|
|
scr = malloc(sizeof(struct mach64screen), M_DEVBUF, M_WAITOK|M_ZERO);
|
|
mach64_init_screen(sc, scr, type, 0, defattrp, sc->active == NULL);
|
|
rasops_init(&scr->ri, mach64_console_screen.ri.ri_height / 16,
|
|
mach64_console_screen.ri.ri_width / 8);
|
|
|
|
scr->mem = malloc(type->ncols * type->nrows * 2, M_DEVBUF,
|
|
M_WAITOK);
|
|
mach64_eraserows(sc, 0, type->nrows, *defattrp);
|
|
if (sc->active == NULL) {
|
|
scr->active = 1;
|
|
sc->active = scr;
|
|
sc->currenttype = type;
|
|
}
|
|
|
|
*cookiep = scr;
|
|
*curxp = scr->cursorcol;
|
|
*curyp = scr->cursorrow;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
mach64_free_screen(void *v, void *cookie)
|
|
{
|
|
struct mach64_softc *sc = v;
|
|
struct mach64screen *scr = cookie;
|
|
|
|
LIST_REMOVE(scr, next);
|
|
if (scr != &mach64_console_screen)
|
|
free(scr, M_DEVBUF);
|
|
else
|
|
panic("mach64_free_screen: console");
|
|
|
|
if (sc->active == scr)
|
|
sc->active = 0;
|
|
}
|
|
|
|
int
|
|
mach64_show_screen(void *v, void *cookie, int waitok,
|
|
void (*cb)(void *, int, int), void *cbarg)
|
|
{
|
|
struct mach64_softc *sc = v;
|
|
struct mach64screen *scr, *oldscr;
|
|
|
|
scr = cookie;
|
|
oldscr = sc->active;
|
|
if (scr == oldscr)
|
|
return 0;
|
|
|
|
sc->wanted = scr;
|
|
sc->switchcb = cb;
|
|
sc->switchcbarg = cbarg;
|
|
if (cb) {
|
|
callout_reset(&sc->switch_callout, 0,
|
|
(void(*)(void *))mach64_switch_screen, sc);
|
|
return EAGAIN;
|
|
}
|
|
|
|
mach64_switch_screen(sc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if 0
|
|
int
|
|
mach64_load_font(void *v, void *cookie, struct wsdisplay_font *data)
|
|
{
|
|
|
|
return 0;
|
|
}
|
|
#endif
|