machfb.c revision 1.3 1 /* $NetBSD: machfb.c,v 1.3 2002/10/25 18:03:03 martin Exp $ */
2
3 /*
4 * Copyright (c) 2002 Bang Jun-Young
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. The name of the author may not be used to endorse or promote products
16 * derived from this software without specific prior written permission
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30 /*
31 * Some code is derived from ATI Rage Pro and Derivatives Programmer's Guide.
32 */
33
34 #include <sys/cdefs.h>
35
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h>
39 #include <sys/device.h>
40 #include <sys/malloc.h>
41 #include <sys/callout.h>
42
43 #ifdef __sparc__
44 #include <machine/openfirm.h>
45 #endif
46
47 #include <dev/ic/videomode.h>
48
49 #include <dev/pci/pcivar.h>
50 #include <dev/pci/pcireg.h>
51 #include <dev/pci/pcidevs.h>
52 #include <dev/pci/pciio.h>
53 #include <dev/pci/machfbreg.h>
54
55 #include <dev/wscons/wsdisplayvar.h>
56 #include <dev/wscons/wsconsio.h>
57 #include <dev/wsfont/wsfont.h>
58 #include <dev/rasops/rasops.h>
59
60 #define MACH64_REG_SIZE 1024
61 #define MACH64_REG_OFF 0x7ffc00
62
63 #define NBARS 3 /* number of Mach64 PCI BARs */
64
65 #ifdef __sparc__
66 int sparc_screen_is_console(struct pci_attach_args *);
67 #endif
68
69 struct vga_bar {
70 bus_addr_t vb_base;
71 bus_size_t vb_size;
72 pcireg_t vb_type;
73 int vb_flags;
74 };
75
76 struct mach64_softc {
77 struct device sc_dev;
78 pci_chipset_tag_t sc_pc;
79 pcitag_t sc_pcitag;
80
81 struct vga_bar sc_bars[NBARS];
82 struct vga_bar sc_rom;
83
84 #define sc_aperbase sc_bars[0].vb_base
85 #define sc_apersize sc_bars[0].vb_size
86
87 #define sc_iobase sc_bars[1].vb_base
88 #define sc_iosize sc_bars[1].vb_size
89
90 #define sc_regbase sc_bars[2].vb_base
91 #define sc_regsize sc_bars[2].vb_size
92
93 bus_space_tag_t sc_memt;
94 bus_space_handle_t sc_memh;
95
96 u_long aperbase;
97 size_t apersize;
98 size_t memsize;
99 int memtype;
100
101 int has_dsp;
102 int bits_per_pixel;
103 int max_x, max_y;
104 int virt_x, virt_y;
105 int color_depth;
106
107 int mem_freq;
108 int ramdac_freq;
109 int ref_freq;
110
111 int ref_div;
112 int log2_vclk_post_div;
113 int vclk_post_div;
114 int vclk_fb_div;
115 int mclk_post_div;
116 int mclk_fb_div;
117
118 struct mach64screen *wanted;
119 struct mach64screen *active;
120 void (*switchcb)(void *, int, int);
121 void *switchcbarg;
122 struct callout switch_callout;
123 int nscreens;
124 LIST_HEAD(, mach64screen) screens;
125 const struct wsscreen_descr *currenttype;
126 };
127
128 struct mach64screen {
129 LIST_ENTRY(mach64screen) next;
130 struct mach64_softc *sc;
131 const struct wsscreen_descr *type;
132 int active;
133 u_int16_t *mem;
134 int dispoffset;
135 int mindispoffset;
136 int maxdispoffset;
137
138 int cursoron;
139 int cursorcol;
140 int cursorrow;
141 u_int16_t cursortmp;
142 };
143
144 struct mach64_crtcregs {
145 u_int32_t h_total_disp;
146 u_int32_t h_sync_strt_wid;
147 u_int32_t v_total_disp;
148 u_int32_t v_sync_strt_wid;
149 u_int32_t gen_cntl;
150 u_int32_t clock_cntl;
151 u_int32_t color_depth;
152 u_int32_t dot_clock;
153 };
154
155 struct {
156 u_int16_t chip_id;
157 u_int32_t ramdac_freq;
158 } mach64_info[] = {
159 { PCI_PRODUCT_ATI_MACH64_CT, 135000 },
160 { PCI_PRODUCT_ATI_RAGE_PRO_AGP, 230000 },
161 { PCI_PRODUCT_ATI_RAGE_PRO_AGP1X, 230000 },
162 { PCI_PRODUCT_ATI_RAGE_PRO_PCI_B, 230000 },
163 { PCI_PRODUCT_ATI_RAGE_XL_AGP, 230000 },
164 { PCI_PRODUCT_ATI_RAGE_PRO_PCI_P, 230000 },
165 { PCI_PRODUCT_ATI_RAGE_PRO_PCI_L, 230000 },
166 { PCI_PRODUCT_ATI_RAGE_XL_PCI, 230000 },
167 { PCI_PRODUCT_ATI_RAGE_II, 135000 },
168 { PCI_PRODUCT_ATI_RAGE_IIP, 200000 },
169 { PCI_PRODUCT_ATI_RAGE_IIC_PCI, 230000 },
170 { PCI_PRODUCT_ATI_RAGE_IIC_AGP_B, 230000 },
171 { PCI_PRODUCT_ATI_RAGE_IIC_AGP_P, 230000 },
172 { PCI_PRODUCT_ATI_RAGE_LT_PRO_AGP, 230000 },
173 { PCI_PRODUCT_ATI_RAGE_MOB_M3_PCI, 230000 },
174 { PCI_PRODUCT_ATI_RAGE_MOB_M3_AGP, 230000 },
175 { PCI_PRODUCT_ATI_RAGE_LT, 230000 },
176 { PCI_PRODUCT_ATI_RAGE_LT_PRO_PCI, 230000 },
177 { PCI_PRODUCT_ATI_RAGE_MOBILITY, 230000 },
178 { PCI_PRODUCT_ATI_RAGE_LT_PRO, 230000 },
179 { PCI_PRODUCT_ATI_MACH64_VT, 170000 },
180 { PCI_PRODUCT_ATI_MACH64_VTB, 200000 },
181 { PCI_PRODUCT_ATI_MACH64_VT4, 230000 }
182 };
183
184 static int mach64_chip_id, mach64_chip_rev;
185 static struct videomode default_mode;
186 struct rasops_info mach64_rasops_info;
187 static struct mach64screen mach64_console_screen;
188
189 static char *mach64_memtype_names[] = {
190 "(N/A)", "DRAM", "EDO DRAM", "EDO DRAM", "SDRAM", "SGRAM", "WRAM",
191 "(unknown type)"
192 };
193
194 struct videomode mach64_modes[] = {
195 /* 640x400 @ 70 Hz, 31.5 kHz */
196 { 25175, 640, 664, 760, 800, 400, 409, 411, 450, 0 },
197 /* 640x480 @ 72 Hz, 36.5 kHz */
198 { 25175, 640, 664, 760, 800, 480, 491, 493, 525, 0 },
199 /* 800x600 @ 72 Hz, 48.0 kHz */
200 { 50000, 800, 856, 976, 1040, 600, 637, 643, 666,
201 VID_PHSYNC | VID_PVSYNC },
202 /* 1024x768 @ 70 Hz, 56.5 kHz */
203 { 75000, 1024, 1048, 1184, 1328, 768, 771, 777, 806,
204 VID_NHSYNC | VID_NVSYNC },
205 /* 1152x864 @ 70 Hz, 62.4 kHz */
206 { 92000, 1152, 1208, 1368, 1474, 864, 865, 875, 895, 0 },
207 /* 1280x1024 @ 70 Hz, 74.59 kHz */
208 { 126500, 1280, 1312, 1472, 1696, 1024, 1032, 1040, 1068,
209 VID_NHSYNC | VID_NVSYNC }
210 };
211
212 /* FIXME values are wrong! */
213 const u_char mach64_cmap[16 * 3] = {
214 0x00, 0x00, 0x00, /* black */
215 0x7f, 0x00, 0x00, /* red */
216 0x00, 0x7f, 0x00, /* green */
217 0x7f, 0x7f, 0x00, /* brown */
218 0x00, 0x00, 0x7f, /* blue */
219 0x7f, 0x00, 0x7f, /* magenta */
220 0x00, 0x7f, 0x7f, /* cyan */
221 0xff, 0xff, 0xff, /* white */
222
223 0x7f, 0x7f, 0x7f, /* black */
224 0xff, 0x00, 0x00, /* red */
225 0x00, 0xff, 0x00, /* green */
226 0xff, 0xff, 0x00, /* brown */
227 0x00, 0x00, 0xff, /* blue */
228 0xff, 0x00, 0xff, /* magenta */
229 0x00, 0xff, 0xff, /* cyan */
230 0xff, 0xff, 0xff, /* white */
231 };
232
233 int mach64_match(struct device *, struct cfdata *, void *);
234 void mach64_attach(struct device *, struct device *, void *);
235
236 CFATTACH_DECL(machfb, sizeof(struct mach64_softc), mach64_match, mach64_attach,
237 NULL, NULL);
238
239 void mach64_init(struct mach64_softc *);
240 int mach64_get_memsize(struct mach64_softc *);
241 int mach64_get_max_ramdac(struct mach64_softc *);
242 void mach64_get_mode(struct mach64_softc *, struct videomode *);
243 int mach64_calc_crtcregs(struct mach64_softc *, struct mach64_crtcregs *,
244 struct videomode *);
245 void mach64_set_crtcregs(struct mach64_softc *, struct mach64_crtcregs *);
246 int mach64_modeswitch(struct mach64_softc *, struct videomode *);
247 void mach64_set_dsp(struct mach64_softc *);
248 void mach64_set_pll(struct mach64_softc *, int);
249 void mach64_reset_engine(struct mach64_softc *);
250 void mach64_init_engine(struct mach64_softc *);
251 void mach64_adjust_frame(struct mach64_softc *, int, int);
252 void mach64_init_lut(struct mach64_softc *);
253 void mach64_switch_screen(struct mach64_softc *);
254 void mach64_init_screen(struct mach64_softc *, struct mach64screen *,
255 const struct wsscreen_descr *, int, long *);
256 void mach64_restore_screen(struct mach64screen *,
257 const struct wsscreen_descr *, u_int16_t *);
258 void mach64_set_screentype(struct mach64_softc *,
259 const struct wsscreen_descr *);
260
261 void mach64_cursor(void *, int, int, int);
262 int mach64_mapchar(void *, int, u_int *);
263 void mach64_putchar(void *, int, int, u_int, long);
264 void mach64_copycols(void *, int, int, int, int);
265 void mach64_erasecols(void *, int, int, int, long);
266 void mach64_copyrows(void *, int, int, int);
267 void mach64_eraserows(void *, int, int, long);
268 int mach64_allocattr(void *, int, int, int, long *);
269
270 const struct wsdisplay_emulops mach64_emulops = {
271 mach64_cursor,
272 mach64_mapchar,
273 mach64_putchar,
274 mach64_copycols,
275 mach64_erasecols,
276 mach64_copyrows,
277 mach64_eraserows,
278 mach64_allocattr,
279 };
280
281 struct wsscreen_descr mach64_defaultscreen = {
282 "default",
283 0, 0,
284 &mach64_rasops_info.ri_ops,
285 8, 16,
286 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
287 &default_mode
288 }, mach64_80x25_screen = {
289 "80x25", 80, 25,
290 &mach64_rasops_info.ri_ops,
291 8, 16,
292 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
293 &mach64_modes[0]
294 }, mach64_80x30_screen = {
295 "80x30", 80, 30,
296 &mach64_rasops_info.ri_ops,
297 8, 16,
298 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
299 &mach64_modes[1]
300 }, mach64_80x40_screen = {
301 "80x40", 80, 40,
302 &mach64_rasops_info.ri_ops,
303 8, 10,
304 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
305 &mach64_modes[0]
306 }, mach64_80x50_screen = {
307 "80x50", 80, 50,
308 &mach64_rasops_info.ri_ops,
309 8, 8,
310 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
311 &mach64_modes[0]
312 }, mach64_100x37_screen = {
313 "100x37", 100, 37,
314 &mach64_rasops_info.ri_ops,
315 8, 16,
316 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
317 &mach64_modes[2]
318 }, mach64_128x48_screen = {
319 "128x48", 128, 48,
320 &mach64_rasops_info.ri_ops,
321 8, 16,
322 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
323 &mach64_modes[3]
324 }, mach64_144x54_screen = {
325 "144x54", 144, 54,
326 &mach64_rasops_info.ri_ops,
327 8, 16,
328 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
329 &mach64_modes[4]
330 }, mach64_160x64_screen = {
331 "160x54", 160, 64,
332 &mach64_rasops_info.ri_ops,
333 8, 16,
334 WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
335 &mach64_modes[5]
336 };
337
338 const struct wsscreen_descr *_mach64_scrlist[] = {
339 &mach64_defaultscreen,
340 &mach64_80x25_screen,
341 &mach64_80x30_screen,
342 &mach64_80x40_screen,
343 &mach64_80x50_screen,
344 &mach64_100x37_screen,
345 &mach64_128x48_screen,
346 &mach64_144x54_screen,
347 &mach64_160x64_screen
348 };
349
350 struct wsscreen_list mach64_screenlist = {
351 sizeof(_mach64_scrlist) / sizeof(struct wsscreen_descr *),
352 _mach64_scrlist
353 };
354
355 int mach64_ioctl(void *, u_long, caddr_t, int, struct proc *);
356 paddr_t mach64_mmap(void *, off_t, int);
357 int mach64_alloc_screen(void *, const struct wsscreen_descr *, void **,
358 int *, int *, long *);
359 void mach64_free_screen(void *, void *);
360 int mach64_show_screen(void *, void *, int, void (*)(void *, int, int),
361 void *);
362 int mach64_load_font(void *, void *, struct wsdisplay_font *);
363
364 struct wsdisplay_accessops mach64_accessops = {
365 mach64_ioctl,
366 mach64_mmap,
367 mach64_alloc_screen,
368 mach64_free_screen,
369 mach64_show_screen,
370 NULL
371 };
372
373 /*
374 * Inline functions for getting access to register aperture.
375 */
376 static inline u_int32_t regr(struct mach64_softc *, u_int32_t);
377 static inline u_int8_t regrb(struct mach64_softc *, u_int32_t);
378 static inline void regw(struct mach64_softc *, u_int32_t, u_int32_t);
379 static inline void regwb(struct mach64_softc *, u_int32_t, u_int8_t);
380 static inline void regwb_pll(struct mach64_softc *, u_int32_t, u_int8_t);
381
382 static inline u_int32_t
383 regr(struct mach64_softc *sc, u_int32_t index)
384 {
385
386 return bus_space_read_4(sc->sc_memt, sc->sc_memh, MACH64_REG_OFF + index);
387 }
388
389 static inline u_int8_t
390 regrb(struct mach64_softc *sc, u_int32_t index)
391 {
392
393 return bus_space_read_1(sc->sc_memt, sc->sc_memh, MACH64_REG_OFF + index);
394 }
395
396 static inline void
397 regw(struct mach64_softc *sc, u_int32_t index, u_int32_t data)
398 {
399
400 bus_space_write_4(sc->sc_memt, sc->sc_memh, MACH64_REG_OFF + index, data);
401 }
402
403 static inline void
404 regwb(struct mach64_softc *sc, u_int32_t index, u_int8_t data)
405 {
406
407 bus_space_write_1(sc->sc_memt, sc->sc_memh, MACH64_REG_OFF + index, data);
408 }
409
410 static inline void
411 regwb_pll(struct mach64_softc *sc, u_int32_t index, u_int8_t data)
412 {
413
414 regwb(sc, CLOCK_CNTL + 1, (index << 2) | PLL_WR_EN);
415 regwb(sc, CLOCK_CNTL + 2, data);
416 regwb(sc, CLOCK_CNTL + 1, (index << 2) & ~PLL_WR_EN);
417 }
418
419 static inline void
420 wait_for_fifo(struct mach64_softc *sc, u_int8_t v)
421 {
422
423 while ((regr(sc, FIFO_STAT) & 0xffff) > (0x8000 >> v))
424 ;
425 }
426
427 static inline void
428 wait_for_idle(struct mach64_softc *sc)
429 {
430
431 wait_for_fifo(sc, 16);
432 while ((regr(sc, GUI_STAT) & 1) != 0)
433 ;
434 }
435
436 int
437 mach64_match(struct device *parent, struct cfdata *match, void *aux)
438 {
439 struct pci_attach_args *pa = (struct pci_attach_args *)aux;
440 int i;
441
442 if (PCI_CLASS(pa->pa_class) != PCI_CLASS_DISPLAY ||
443 PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_DISPLAY_VGA)
444 return 0;
445
446 for (i = 0; i < sizeof(mach64_info) / sizeof(mach64_info[0]); i++)
447 if (PCI_PRODUCT(pa->pa_id) == mach64_info[i].chip_id) {
448 mach64_chip_id = PCI_PRODUCT(pa->pa_id);
449 mach64_chip_rev = PCI_REVISION(pa->pa_class);
450 return 1;
451 }
452
453 return 0;
454 }
455
456 void
457 mach64_attach(struct device *parent, struct device *self, void *aux)
458 {
459 struct mach64_softc *sc = (void *)self;
460 struct pci_attach_args *pa = aux;
461 char devinfo[256];
462 int bar, reg, id;
463 struct wsemuldisplaydev_attach_args aa;
464 int console;
465 long defattr;
466
467 sc->sc_pc = pa->pa_pc;
468 sc->sc_pcitag = pa->pa_tag;
469
470 pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo);
471 printf(": %s (rev. 0x%02x)\n", devinfo, PCI_REVISION(pa->pa_class));
472
473 for (bar = 0; bar < NBARS; bar++) {
474 reg = PCI_MAPREG_START + (bar * 4);
475 sc->sc_bars[bar].vb_type = pci_mapreg_type(sc->sc_pc,
476 sc->sc_pcitag, reg);
477 (void)pci_mapreg_info(sc->sc_pc, sc->sc_pcitag, reg,
478 sc->sc_bars[bar].vb_type, &sc->sc_bars[bar].vb_base,
479 &sc->sc_bars[bar].vb_size, &sc->sc_bars[bar].vb_flags);
480 }
481 sc->sc_memt = pa->pa_memt;
482
483 mach64_init(sc);
484
485 sc->aperbase = (vaddr_t)bus_space_vaddr(sc->sc_memt, sc->sc_memh);
486 sc->apersize = sc->sc_apersize;
487
488 #if _BYTE_ORDER == _BIG_ENDIAN
489 sc->aperbase += 0x800000;
490 sc->apersize -= 0x800000;
491 #endif
492
493 printf("%s: %d MB aperture at 0x%08x, %d KB registers at 0x%08x\n",
494 sc->sc_dev.dv_xname, (u_int)(sc->apersize / (1024 * 1024)),
495 (u_int)sc->aperbase, (u_int)(MACH64_REG_SIZE / 1024),
496 (u_int)MACH64_REG_OFF);
497
498 if (mach64_chip_id == PCI_PRODUCT_ATI_MACH64_CT ||
499 ((mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
500 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II) &&
501 (mach64_chip_rev & 0x07) == 0))
502 sc->has_dsp = 0;
503 else
504 sc->has_dsp = 1;
505
506 sc->memsize = mach64_get_memsize(sc);
507 if (sc->memsize == 8192)
508 /* The last page is used as register aperture. */
509 sc->memsize -= 4;
510 sc->memtype = regr(sc, CONFIG_STAT0) & 0x07;
511
512 /* XXX is there any way to calculate reference frequency from
513 known values? */
514 if (mach64_chip_id == PCI_PRODUCT_ATI_RAGE_XL_PCI)
515 sc->ref_freq = 29498;
516 else
517 sc->ref_freq = 14318;
518
519 regwb(sc, CLOCK_CNTL + 1, PLL_REF_DIV << 2);
520 sc->ref_div = regrb(sc, CLOCK_CNTL + 2);
521 regwb(sc, CLOCK_CNTL + 1, MCLK_FB_DIV << 2);
522 sc->mclk_fb_div = regrb(sc, CLOCK_CNTL + 2);
523 sc->mem_freq = (2 * sc->ref_freq * sc->mclk_fb_div) /
524 (sc->ref_div * 2);
525 sc->mclk_post_div = (sc->mclk_fb_div * 2 * sc->ref_freq) /
526 (sc->mem_freq * sc->ref_div);
527 sc->ramdac_freq = mach64_get_max_ramdac(sc);
528 printf("%s: %ld KB %s %d.%d MHz, maximum RAMDAC clock %d MHz\n",
529 sc->sc_dev.dv_xname, sc->memsize,
530 mach64_memtype_names[sc->memtype],
531 sc->mem_freq / 1000, sc->mem_freq % 1000,
532 sc->ramdac_freq / 1000);
533
534 id = regr(sc, CONFIG_CHIP_ID) & 0xffff;
535 if (id != mach64_chip_id) {
536 printf("%s: chip ID mismatch, 0x%x != 0x%x\n",
537 sc->sc_dev.dv_xname, id, mach64_chip_id);
538 return;
539 }
540
541 #ifdef __sparc__
542 mach64_get_mode(sc, &default_mode);
543 #else
544 memcpy(&default_mode, &mach64_modes[0], sizeof(struct videomode)) ;
545 #endif
546
547 sc->bits_per_pixel = 8;
548 sc->virt_x = default_mode.hdisplay;
549 sc->virt_y = default_mode.vdisplay;
550 sc->max_x = sc->virt_x - 1;
551 sc->max_y = (sc->memsize * 1024) /
552 (sc->virt_x * (sc->bits_per_pixel / 8)) - 1;
553
554 sc->color_depth = CRTC_PIX_WIDTH_8BPP;
555
556 mach64_init_engine(sc);
557 #if 0
558 mach64_adjust_frame(0, 0);
559 if (sc->bits_per_pixel == 8)
560 mach64_init_lut(sc);
561 #endif
562
563 printf("%s: initial resolution %dx%d at %d bpp\n", sc->sc_dev.dv_xname,
564 default_mode.hdisplay, default_mode.vdisplay,
565 sc->bits_per_pixel);
566
567 mach64_rasops_info.ri_depth = sc->bits_per_pixel;
568 mach64_rasops_info.ri_bits = (void *)sc->aperbase;
569 mach64_rasops_info.ri_width = default_mode.hdisplay;
570 mach64_rasops_info.ri_height = default_mode.vdisplay;
571 mach64_rasops_info.ri_stride = mach64_rasops_info.ri_width;
572 mach64_rasops_info.ri_flg = RI_CLEAR;
573
574 rasops_init(&mach64_rasops_info, mach64_rasops_info.ri_height / 16,
575 mach64_rasops_info.ri_width / 8);
576
577 mach64_defaultscreen.nrows = mach64_rasops_info.ri_rows;
578 mach64_defaultscreen.ncols = mach64_rasops_info.ri_cols;
579
580 mach64_init_screen(sc, &mach64_console_screen,
581 &mach64_defaultscreen, 1, &defattr);
582
583 mach64_rasops_info.ri_ops.allocattr(&mach64_rasops_info, 0, 0, 0,
584 &defattr);
585
586 #ifdef __sparc__
587 console = sparc_screen_is_console(pa);
588 #else
589 console = 1;
590 #endif
591
592 if (console)
593 wsdisplay_cnattach(&mach64_defaultscreen, &mach64_rasops_info,
594 0, 0, defattr);
595
596 aa.console = console;
597 aa.scrdata = &mach64_screenlist;
598 aa.accessops = &mach64_accessops;
599 aa.accesscookie = sc;
600
601 config_found(self, &aa, wsemuldisplaydevprint);
602 }
603
604 void
605 mach64_init_screen(struct mach64_softc *sc, struct mach64screen *scr,
606 const struct wsscreen_descr *type, int existing, long *attrp)
607 {
608 #if !defined(__sparc__)
609 struct videomode *mode = (struct videomode *)type->modecookie;
610 #endif
611
612 scr->sc = sc;
613 scr->type = type;
614 scr->mindispoffset = 0;
615 scr->maxdispoffset = sc->memsize * 1024;
616 scr->dispoffset = 0;
617 scr->cursorcol = 0;
618 scr->cursorrow = 0;
619
620 if (existing) {
621 scr->mem = (u_int16_t *)malloc(type->nrows * type->ncols * 2,
622 M_DEVBUF, M_WAITOK);
623 scr->active = 1;
624
625 #if !defined(__sparc__)
626 if (mach64_modeswitch(sc, mode)) {
627 panic("%s: failed to switch video mode",
628 sc->sc_dev.dv_xname);
629 }
630 #endif
631 } else {
632 scr->active = 0;
633 scr->mem = NULL;
634 }
635
636 wsfont_init();
637
638 sc->nscreens++;
639 LIST_INSERT_HEAD(&sc->screens, scr, next);
640 }
641
642 void
643 mach64_init(struct mach64_softc *sc)
644 {
645 if (bus_space_map(sc->sc_memt, sc->sc_aperbase, sc->sc_apersize,
646 BUS_SPACE_MAP_LINEAR, &sc->sc_memh)) {
647 panic("%s: failed to map aperture", sc->sc_dev.dv_xname);
648 }
649
650 sc->nscreens = 0;
651 LIST_INIT(&sc->screens);
652 sc->active = NULL;
653 sc->currenttype = &mach64_defaultscreen;
654 callout_init(&sc->switch_callout);
655 }
656
657 int
658 mach64_get_memsize(struct mach64_softc *sc)
659 {
660 int tmp, memsize;
661 int mem_tab[] = {
662 512, 1024, 2048, 4096, 6144, 8192, 12288, 16384
663 };
664
665 tmp = regr(sc, MEM_CNTL);
666 if (sc->has_dsp) {
667 tmp &= 0x0000000f;
668 if (tmp < 8)
669 memsize = (tmp + 1) * 512;
670 else if (tmp < 12)
671 memsize = (tmp - 3) * 1024;
672 else
673 memsize = (tmp - 7) * 2048;
674 } else {
675 memsize = mem_tab[tmp & 0x07];
676 }
677
678 return memsize;
679 }
680
681 int
682 mach64_get_max_ramdac(struct mach64_softc *sc)
683 {
684 int i;
685
686 if ((mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
687 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II) &&
688 (mach64_chip_rev & 0x07))
689 return 170000;
690
691 for (i = 0; i < sizeof(mach64_info) / sizeof(mach64_info[0]); i++)
692 if (mach64_chip_id == mach64_info[i].chip_id)
693 return mach64_info[i].ramdac_freq;
694
695 if (sc->bits_per_pixel == 8)
696 return 135000;
697 else
698 return 80000;
699 }
700
701 void
702 mach64_get_mode(struct mach64_softc *sc, struct videomode *mode)
703 {
704 struct mach64_crtcregs crtc;
705
706 crtc.h_total_disp = regr(sc, CRTC_H_TOTAL_DISP);
707 crtc.h_sync_strt_wid = regr(sc, CRTC_H_SYNC_STRT_WID);
708 crtc.v_total_disp = regr(sc, CRTC_V_TOTAL_DISP);
709 crtc.v_sync_strt_wid = regr(sc, CRTC_V_SYNC_STRT_WID);
710
711 mode->htotal = ((crtc.h_total_disp & 0xffff) + 1) << 3;
712 mode->hdisplay = ((crtc.h_total_disp >> 16) + 1) << 3;
713 mode->hsync_start = ((crtc.h_sync_strt_wid & 0xffff) + 1) << 3;
714 mode->hsync_end = ((crtc.h_sync_strt_wid >> 16) << 3) +
715 mode->hsync_start;
716 mode->vtotal = (crtc.v_total_disp & 0xffff) + 1;
717 mode->vdisplay = (crtc.v_total_disp >> 16) + 1;
718 mode->vsync_start = (crtc.v_sync_strt_wid & 0xffff) + 1;
719 mode->vsync_end = (crtc.v_sync_strt_wid >> 16) + mode->vsync_start;
720
721 #ifdef MACH64_DEBUG
722 printf("mach64_get_mode: %d %d %d %d %d %d %d %d\n",
723 mode->hdisplay, mode->hsync_start, mode->hsync_end, mode->htotal,
724 mode->vdisplay, mode->vsync_start, mode->vsync_end, mode->vtotal);
725 #endif
726 }
727
728 int
729 mach64_calc_crtcregs(struct mach64_softc *sc, struct mach64_crtcregs *crtc,
730 struct videomode *mode)
731 {
732
733 if (mode->dot_clock > sc->ramdac_freq)
734 /* Clock too high. */
735 return 1;
736
737 crtc->h_total_disp = (((mode->hdisplay >> 3) - 1) << 16) |
738 ((mode->htotal >> 3) - 1);
739 crtc->h_sync_strt_wid =
740 (((mode->hsync_end - mode->hsync_start) >> 3) << 16) |
741 ((mode->hsync_start >> 3) - 1);
742
743 crtc->v_total_disp = ((mode->vdisplay - 1) << 16) |
744 (mode->vtotal - 1);
745 crtc->v_sync_strt_wid =
746 ((mode->vsync_end - mode->vsync_start) << 16) |
747 (mode->vsync_start - 1);
748
749 if (mode->flags & VID_NVSYNC)
750 crtc->v_sync_strt_wid |= CRTC_VSYNC_NEG;
751
752 switch (sc->bits_per_pixel) {
753 case 8:
754 crtc->color_depth = CRTC_PIX_WIDTH_8BPP;
755 break;
756 case 16:
757 crtc->color_depth = CRTC_PIX_WIDTH_16BPP;
758 break;
759 case 32:
760 crtc->color_depth = CRTC_PIX_WIDTH_32BPP;
761 break;
762 }
763
764 crtc->gen_cntl = 0;
765 if (mode->flags & VID_INTERLACE)
766 crtc->gen_cntl |= CRTC_INTERLACE_EN;
767 if (mode->flags & VID_CSYNC)
768 crtc->gen_cntl |= CRTC_CSYNC_EN;
769
770 crtc->dot_clock = mode->dot_clock;
771
772 return 0;
773 }
774
775 void
776 mach64_set_crtcregs(struct mach64_softc *sc, struct mach64_crtcregs *crtc)
777 {
778
779 mach64_set_pll(sc, crtc->dot_clock);
780
781 if (sc->has_dsp)
782 mach64_set_dsp(sc);
783
784 regw(sc, CRTC_H_TOTAL_DISP, crtc->h_total_disp);
785 regw(sc, CRTC_H_SYNC_STRT_WID, crtc->h_sync_strt_wid);
786 regw(sc, CRTC_V_TOTAL_DISP, crtc->v_total_disp);
787 regw(sc, CRTC_V_SYNC_STRT_WID, crtc->v_sync_strt_wid);
788
789 regw(sc, CRTC_VLINE_CRNT_VLINE, 0);
790
791 regw(sc, CRTC_OFF_PITCH, (sc->virt_x >> 3) << 22);
792
793 regw(sc, CRTC_GEN_CNTL, crtc->gen_cntl | crtc->color_depth |
794 CRTC_EXT_DISP_EN | CRTC_EXT_EN);
795 }
796
797 int
798 mach64_modeswitch(struct mach64_softc *sc, struct videomode *mode)
799 {
800 struct mach64_crtcregs crtc;
801
802 if (mach64_calc_crtcregs(sc, &crtc, mode))
803 return 1;
804
805 mach64_set_crtcregs(sc, &crtc);
806 return 0;
807 }
808
809 void
810 mach64_reset_engine(struct mach64_softc *sc)
811 {
812
813 /* Reset engine.*/
814 regw(sc, GEN_TEST_CNTL, regr(sc, GEN_TEST_CNTL) & ~GUI_ENGINE_ENABLE);
815
816 /* Enable engine. */
817 regw(sc, GEN_TEST_CNTL, regr(sc, GEN_TEST_CNTL) | GUI_ENGINE_ENABLE);
818
819 /* Ensure engine is not locked up by clearing any FIFO or
820 host errors. */
821 regw(sc, BUS_CNTL, regr(sc, BUS_CNTL) | BUS_HOST_ERR_ACK |
822 BUS_FIFO_ERR_ACK);
823 }
824
825 void
826 mach64_init_engine(struct mach64_softc *sc)
827 {
828 u_int32_t pitch_value;
829
830 pitch_value = sc->virt_x;
831
832 if (sc->bits_per_pixel == 24)
833 pitch_value *= 3;
834
835 mach64_reset_engine(sc);
836
837 wait_for_fifo(sc, 14);
838
839 regw(sc, CONTEXT_MASK, 0xffffffff);
840
841 regw(sc, DST_OFF_PITCH, (pitch_value / 8) << 22);
842
843 regw(sc, DST_Y_X, 0);
844 regw(sc, DST_HEIGHT, 0);
845 regw(sc, DST_BRES_ERR, 0);
846 regw(sc, DST_BRES_INC, 0);
847 regw(sc, DST_BRES_DEC, 0);
848
849 regw(sc, DST_CNTL, DST_LAST_PEL | DST_X_LEFT_TO_RIGHT |
850 DST_Y_TOP_TO_BOTTOM);
851
852 regw(sc, SRC_OFF_PITCH, (pitch_value / 8) << 22);
853
854 regw(sc, SRC_Y_X, 0);
855 regw(sc, SRC_HEIGHT1_WIDTH1, 1);
856 regw(sc, SRC_Y_X_START, 0);
857 regw(sc, SRC_HEIGHT2_WIDTH2, 1);
858
859 regw(sc, SRC_CNTL, SRC_LINE_X_LEFT_TO_RIGHT);
860
861 wait_for_fifo(sc, 13);
862 regw(sc, HOST_CNTL, 0);
863
864 regw(sc, PAT_REG0, 0);
865 regw(sc, PAT_REG1, 0);
866 regw(sc, PAT_CNTL, 0);
867
868 regw(sc, SC_LEFT, 0);
869 regw(sc, SC_TOP, 0);
870 regw(sc, SC_BOTTOM, default_mode.vdisplay - 1);
871 regw(sc, SC_RIGHT, pitch_value - 1);
872
873 regw(sc, DP_BKGD_CLR, 0);
874 regw(sc, DP_FRGD_CLR, 0xffffffff);
875 regw(sc, DP_WRITE_MASK, 0xffffffff);
876 regw(sc, DP_MIX, (MIX_SRC << 16) | MIX_DST);
877
878 regw(sc, DP_SRC, FRGD_SRC_FRGD_CLR);
879
880 wait_for_fifo(sc, 3);
881 regw(sc, CLR_CMP_CLR, 0);
882 regw(sc, CLR_CMP_MASK, 0xffffffff);
883 regw(sc, CLR_CMP_CNTL, 0);
884
885 wait_for_fifo(sc, 2);
886 switch (sc->bits_per_pixel) {
887 case 8:
888 regw(sc, DP_PIX_WIDTH, HOST_8BPP | SRC_8BPP | DST_8BPP);
889 regw(sc, DP_CHAIN_MASK, DP_CHAIN_8BPP);
890 regw(sc, DAC_CNTL, regr(sc, DAC_CNTL) & ~DAC_8BIT_EN);
891 break;
892 #if 0
893 case 32:
894 regw(sc, DP_PIX_WIDTH, HOST_32BPP | SRC_32BPP | DST_32BPP);
895 regw(sc, DP_CHAIN_MASK, DP_CHAIN_32BPP);
896 regw(sc, DAC_CNTL, regr(sc, DAC_CNTL) | DAC_8BIT_EN);
897 break;
898 #endif
899 }
900
901 wait_for_fifo(sc, 5);
902 regw(sc, CRTC_INT_CNTL, regr(sc, CRTC_INT_CNTL) & ~0x20);
903 regw(sc, GUI_TRAJ_CNTL, DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM);
904
905 wait_for_idle(sc);
906 }
907
908 void
909 mach64_adjust_frame(struct mach64_softc *sc, int x, int y)
910 {
911 int offset;
912
913 offset = ((x + y * sc->virt_x) * (sc->bits_per_pixel >> 3)) >> 3;
914
915 regw(sc, CRTC_OFF_PITCH, (regr(sc, CRTC_OFF_PITCH) & 0xfff00000) |
916 offset);
917 }
918
919 void
920 mach64_set_dsp(struct mach64_softc *sc)
921 {
922 u_int32_t fifo_depth, page_size, dsp_precision, dsp_loop_latency;
923 u_int32_t dsp_off, dsp_on, dsp_xclks_per_qw;
924 u_int32_t xclks_per_qw, y;
925 u_int32_t fifo_off, fifo_on;
926
927 if (mach64_chip_id == PCI_PRODUCT_ATI_MACH64_VT ||
928 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_II ||
929 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIP ||
930 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_PCI ||
931 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_AGP_B ||
932 mach64_chip_id == PCI_PRODUCT_ATI_RAGE_IIC_AGP_P) {
933 dsp_loop_latency = 0;
934 fifo_depth = 24;
935 } else {
936 dsp_loop_latency = 2;
937 fifo_depth = 32;
938 }
939
940 dsp_precision = 0;
941 xclks_per_qw = (sc->mclk_fb_div * sc->vclk_post_div * 64 << 11) /
942 (sc->vclk_fb_div * sc->mclk_post_div * sc->bits_per_pixel);
943 y = (xclks_per_qw * fifo_depth) >> 11;
944 while (y) {
945 y >>= 1;
946 dsp_precision++;
947 }
948 dsp_precision -= 5;
949 fifo_off = ((xclks_per_qw * (fifo_depth - 1)) >> 5) + (3 << 6);
950
951 switch (sc->memtype) {
952 case DRAM:
953 case EDO_DRAM:
954 case PSEUDO_EDO:
955 if (sc->memsize > 1024) {
956 page_size = 9;
957 dsp_loop_latency += 6;
958 } else {
959 page_size = 10;
960 if (sc->memtype == DRAM)
961 dsp_loop_latency += 8;
962 else
963 dsp_loop_latency += 7;
964 }
965 break;
966 case SDRAM:
967 case SGRAM:
968 if (sc->memsize > 1024) {
969 page_size = 8;
970 dsp_loop_latency += 8;
971 } else {
972 page_size = 10;
973 dsp_loop_latency += 9;
974 }
975 break;
976 default:
977 page_size = 10;
978 dsp_loop_latency += 9;
979 break;
980 }
981
982 if (xclks_per_qw >= (page_size << 11))
983 fifo_on = ((2 * page_size + 1) << 6) + (xclks_per_qw >> 5);
984 else
985 fifo_on = (3 * page_size + 2) << 6;
986
987 dsp_xclks_per_qw = xclks_per_qw >> dsp_precision;
988 dsp_on = fifo_on >> dsp_precision;
989 dsp_off = fifo_off >> dsp_precision;
990
991 #ifdef MACH64_DEBUG
992 printf("dsp_xclks_per_qw = %d, dsp_on = %d, dsp_off = %d,\n"
993 "dsp_precision = %d, dsp_loop_latency = %d,\n"
994 "mclk_fb_div = %d, vclk_fb_div = %d,\n"
995 "mclk_post_div = %d, vclk_post_div = %d\n",
996 dsp_xclks_per_qw, dsp_on, dsp_off, dsp_precision, dsp_loop_latency,
997 sc->mclk_fb_div, sc->vclk_fb_div,
998 sc->mclk_post_div, sc->vclk_post_div);
999 #endif
1000
1001 regw(sc, DSP_ON_OFF, ((dsp_on << 16) & DSP_ON) | (dsp_off & DSP_OFF));
1002 regw(sc, DSP_CONFIG, ((dsp_precision << 20) & DSP_PRECISION) |
1003 ((dsp_loop_latency << 16) & DSP_LOOP_LATENCY) |
1004 (dsp_xclks_per_qw & DSP_XCLKS_PER_QW));
1005 }
1006
1007 void
1008 mach64_set_pll(struct mach64_softc *sc, int clock)
1009 {
1010 int q;
1011
1012 q = (clock * sc->ref_div * 100) / (2 * sc->ref_freq);
1013 #ifdef MACH64_DEBUG
1014 printf("q = %d\n", q);
1015 #endif
1016 if (q > 25500) {
1017 printf("Warning: q > 25500\n");
1018 q = 25500;
1019 sc->vclk_post_div = 1;
1020 sc->log2_vclk_post_div = 0;
1021 } else if (q > 12750) {
1022 sc->vclk_post_div = 1;
1023 sc->log2_vclk_post_div = 0;
1024 } else if (q > 6350) {
1025 sc->vclk_post_div = 2;
1026 sc->log2_vclk_post_div = 1;
1027 } else if (q > 3150) {
1028 sc->vclk_post_div = 4;
1029 sc->log2_vclk_post_div = 2;
1030 } else if (q >= 1600) {
1031 sc->vclk_post_div = 8;
1032 sc->log2_vclk_post_div = 3;
1033 } else {
1034 printf("Warning: q < 1600\n");
1035 sc->vclk_post_div = 8;
1036 sc->log2_vclk_post_div = 3;
1037 }
1038 sc->vclk_fb_div = q * sc->vclk_post_div / 100;
1039
1040 regwb_pll(sc, MCLK_FB_DIV, sc->mclk_fb_div);
1041 regwb_pll(sc, VCLK_POST_DIV, sc->log2_vclk_post_div);
1042 regwb_pll(sc, VCLK0_FB_DIV, sc->vclk_fb_div);
1043 }
1044
1045 void
1046 mach64_init_lut(struct mach64_softc *sc)
1047 {
1048 int i;
1049
1050 regwb(sc, DAC_REGS, 0);
1051
1052 for (i = 0; i < 16; i++) {
1053 regwb(sc, DAC_REGS + 1, mach64_cmap[i * 3]);
1054 regwb(sc, DAC_REGS + 1, mach64_cmap[i * 3 + 1]);
1055 regwb(sc, DAC_REGS + 1, mach64_cmap[i + 3 + 2]);
1056 }
1057 }
1058
1059 void
1060 mach64_switch_screen(struct mach64_softc *sc)
1061 {
1062 struct mach64screen *scr, *oldscr;
1063 const struct wsscreen_descr *type;
1064
1065 scr = sc->wanted;
1066 if (!scr) {
1067 printf("mach64_switch_screen: disappeared\n");
1068 (*sc->switchcb)(sc->switchcbarg, EIO, 0);
1069 return;
1070 }
1071 type = scr->type;
1072 oldscr = sc->active; /* can be NULL! */
1073 #ifdef DIAGNOSTIC
1074 if (oldscr) {
1075 if (!oldscr->active)
1076 panic("mach64_switch_screen: not active");
1077 if (oldscr->type != vc->currenttype)
1078 panic("mach64_switch_screen: bad type");
1079 }
1080 #endif
1081 if (scr == oldscr)
1082 return;
1083
1084 #ifdef DIAGNOSTIC
1085 if (scr->active)
1086 panic("mach64_switch_screen: active");
1087 #endif
1088
1089 if (oldscr)
1090 oldscr->active = 0;
1091
1092 if (sc->currenttype != type) {
1093 mach64_set_screentype(sc, type);
1094 sc->currenttype = type;
1095 }
1096
1097 scr->dispoffset = scr->mindispoffset;
1098
1099 if (!oldscr || (scr->dispoffset != oldscr->dispoffset)) {
1100
1101 }
1102
1103 /* Clear the entire screen. */
1104
1105 scr->active = 1;
1106 mach64_restore_screen(scr, type, scr->mem);
1107
1108 sc->active = scr;
1109
1110 mach64_cursor(scr, scr->cursoron, scr->cursorrow, scr->cursorcol);
1111
1112 sc->wanted = 0;
1113 if (sc->switchcb)
1114 (*sc->switchcb)(sc->switchcbarg, 0, 0);
1115 }
1116
1117 void
1118 mach64_restore_screen(struct mach64screen *scr,
1119 const struct wsscreen_descr *type, u_int16_t *mem)
1120 {
1121
1122 }
1123
1124 void
1125 mach64_set_screentype(struct mach64_softc *sc, const struct wsscreen_descr *des)
1126 {
1127
1128 }
1129
1130 /*
1131 * wsdisplay_emulops
1132 */
1133
1134 void
1135 mach64_cursor(void *cookie, int on, int row, int col)
1136 {
1137
1138 }
1139
1140 int
1141 mach64_mapchar(void *cookie, int uni, u_int *index)
1142 {
1143
1144 return 0;
1145 }
1146
1147 void
1148 mach64_putchar(void *cookie, int row, int col, u_int c, long attr)
1149 {
1150
1151 }
1152
1153 void
1154 mach64_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
1155 {
1156
1157 }
1158
1159 void
1160 mach64_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
1161 {
1162
1163 }
1164
1165 void
1166 mach64_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
1167 {
1168
1169 }
1170
1171 void
1172 mach64_eraserows(void *cookie, int row, int nrows, long fillattr)
1173 {
1174
1175 }
1176
1177 int
1178 mach64_allocattr(void *cookie, int fg, int bg, int flags, long *attrp)
1179 {
1180
1181 return 0;
1182 }
1183
1184 /*
1185 * wsdisplay_accessops
1186 */
1187
1188 int
1189 mach64_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
1190 {
1191
1192 return ENOTTY;
1193 }
1194
1195 paddr_t
1196 mach64_mmap(void *v, off_t offset, int prot)
1197 {
1198
1199 return -1;
1200 }
1201
1202 int
1203 mach64_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
1204 int *curxp, int *curyp, long *defattrp)
1205 {
1206 struct mach64_softc *sc = v;
1207 struct mach64screen *scr;
1208
1209 if (sc->nscreens == 1)
1210 sc->screens.lh_first->mem = scr->mem;
1211
1212 scr = malloc(sizeof(struct mach64screen), M_DEVBUF, M_WAITOK);
1213 mach64_init_screen(sc, scr, type, 0, defattrp);
1214
1215 if (sc->nscreens == 1) {
1216 scr->active = 1;
1217 sc->active = scr;
1218 sc->currenttype = type;
1219 } else {
1220 scr->mem = malloc(type->ncols * type->nrows * 2, M_DEVBUF,
1221 M_WAITOK);
1222 mach64_eraserows(sc, 0, type->nrows, *defattrp);
1223 }
1224
1225 *cookiep = scr;
1226 *curxp = scr->cursorcol;
1227 *curyp = scr->cursorrow;
1228
1229 return 0;
1230 }
1231
1232 void
1233 mach64_free_screen(void *v, void *cookie)
1234 {
1235 struct mach64_softc *sc = v;
1236 struct mach64screen *scr = cookie;
1237
1238 LIST_REMOVE(scr, next);
1239 if (scr != &mach64_console_screen)
1240 free(scr, M_DEVBUF);
1241 else
1242 panic("mach64_free_screen: console");
1243
1244 if (sc->active == scr)
1245 sc->active = 0;
1246 }
1247
1248 int
1249 mach64_show_screen(void *v, void *cookie, int waitok,
1250 void (*cb)(void *, int, int), void *cbarg)
1251 {
1252 struct mach64_softc *sc = v;
1253 struct mach64screen *scr, *oldscr;
1254
1255 scr = cookie;
1256 oldscr = sc->active;
1257 if (scr == oldscr)
1258 return 0;
1259
1260 sc->wanted = scr;
1261 sc->switchcb = cb;
1262 sc->switchcbarg = cbarg;
1263 if (cb) {
1264 callout_reset(&sc->switch_callout, 0,
1265 (void(*)(void *))mach64_switch_screen, sc);
1266 return EAGAIN;
1267 }
1268
1269 mach64_switch_screen(sc);
1270
1271 return 0;
1272 }
1273
1274 int
1275 mach64_load_font(void *v, void *cookie, struct wsdisplay_font *data)
1276 {
1277
1278 return 0;
1279 }
1280
1281 #ifdef __sparc__
1282 int
1283 sparc_screen_is_console(struct pci_attach_args *pa)
1284 {
1285 int node;
1286
1287 node = PCITAG_NODE(pa->pa_tag);
1288 if (node == -1)
1289 return 0;
1290
1291 return (node == OF_instance_to_package(OF_stdout()));
1292 }
1293 #endif
1294