Home | History | Annotate | Line # | Download | only in ic
vga_subr.c revision 1.13
      1 /* $NetBSD: vga_subr.c,v 1.13 2003/01/27 15:22:47 tsutsui Exp $ */
      2 
      3 /*
      4  * Copyright (c) 1998
      5  *	Matthias Drochner.  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. All advertising materials mentioning features or use of this software
     16  *    must display the following acknowledgement:
     17  *	This product includes software developed for the NetBSD Project
     18  *	by Matthias Drochner.
     19  * 4. The name of the author may not be used to endorse or promote products
     20  *    derived from this software without specific prior written permission.
     21  *
     22  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32  *
     33  */
     34 
     35 #include <sys/cdefs.h>
     36 __KERNEL_RCSID(0, "$NetBSD: vga_subr.c,v 1.13 2003/01/27 15:22:47 tsutsui Exp $");
     37 
     38 #include <sys/param.h>
     39 #include <sys/systm.h>
     40 #include <sys/device.h>
     41 #include <sys/queue.h>
     42 #include <machine/bus.h>
     43 
     44 #include <dev/ic/mc6845reg.h>
     45 #include <dev/ic/pcdisplayvar.h>
     46 #include <dev/ic/vgareg.h>
     47 #include <dev/ic/vgavar.h>
     48 
     49 #include <dev/wscons/wsdisplayvar.h>
     50 
     51 static void fontram(struct vga_handle *);
     52 static void textram(struct vga_handle *);
     53 
     54 static void
     55 fontram(struct vga_handle *vh)
     56 {
     57 
     58 	/* program sequencer to access character generator */
     59 
     60 	vga_ts_write(vh, syncreset, 0x01);	/* synchronous reset */
     61 	vga_ts_write(vh, wrplmask, 0x04);	/* write to map 2 */
     62 	vga_ts_write(vh, memmode, 0x07);	/* sequential addressing */
     63 	vga_ts_write(vh, syncreset, 0x03);	/* clear synchronous reset */
     64 
     65 	/* program graphics controller to access character generator */
     66 
     67 	vga_gdc_write(vh, rdplanesel, 0x02);	/* select map 2 for cpu reads */
     68 	vga_gdc_write(vh, mode, 0x00);	/* disable odd-even addressing */
     69 	vga_gdc_write(vh, misc, 0x04);	/* map starts at 0xA000 */
     70 }
     71 
     72 static void
     73 textram(struct vga_handle *vh)
     74 {
     75 
     76 	/* program sequencer to access video ram */
     77 
     78 	vga_ts_write(vh, syncreset, 0x01);	/* synchronous reset */
     79 	vga_ts_write(vh, wrplmask, 0x03);	/* write to map 0 & 1 */
     80 	vga_ts_write(vh, memmode, 0x03);	/* odd-even addressing */
     81 	vga_ts_write(vh, syncreset, 0x03);	/* clear synchronous reset */
     82 
     83 	/* program graphics controller for text mode */
     84 
     85 	vga_gdc_write(vh, rdplanesel, 0x00);	/* select map 0 for cpu reads */
     86 	vga_gdc_write(vh, mode, 0x10);		/* enable odd-even addressing */
     87 	/* map starts at 0xb800 or 0xb000 (mono) */
     88 	vga_gdc_write(vh, misc, (vh->vh_mono ? 0x0a : 0x0e));
     89 }
     90 
     91 #ifndef VGA_RASTERCONSOLE
     92 void
     93 vga_loadchars(struct vga_handle *vh, int fontset, int first, int num, int lpc,
     94 	      char *data)
     95 {
     96 	int offset, i, j, s;
     97 
     98 	/* fontset number swizzle done in vga_setfontset() */
     99 	offset = (fontset << 13) | (first << 5);
    100 
    101 	s = splhigh();
    102 	fontram(vh);
    103 
    104 	for (i = 0; i < num; i++)
    105 		for (j = 0; j < lpc; j++)
    106 			bus_space_write_1(vh->vh_memt, vh->vh_allmemh,
    107 			    offset + (i << 5) + j, data[i * lpc + j]);
    108 
    109 	textram(vh);
    110 	splx(s);
    111 }
    112 
    113 void
    114 vga_readoutchars(struct vga_handle *vh, int fontset, int first, int num,
    115 		 int lpc, char *data)
    116 {
    117 	int offset, i, j, s;
    118 
    119 	/* fontset number swizzle done in vga_setfontset() */
    120 	offset = (fontset << 13) | (first << 5);
    121 
    122 	s = splhigh();
    123 	fontram(vh);
    124 
    125 	for (i = 0; i < num; i++)
    126 		for (j = 0; j < lpc; j++)
    127 			data[i * lpc + j] = bus_space_read_1(vh->vh_memt,
    128 			    vh->vh_allmemh, offset + (i << 5) + j);
    129 
    130 	textram(vh);
    131 	splx(s);
    132 }
    133 
    134 #ifdef VGA_CONSOLE_ATI_BROKEN_FONTSEL
    135 void
    136 vga_copyfont01(struct vga_handle *vh)
    137 {
    138 	int s;
    139 
    140 	s = splhigh();
    141 	fontram(vh);
    142 
    143 	bus_space_copy_region_1(vh->vh_memt, vh->vh_allmemh, 0,
    144 	    vh->vh_allmemh, 1 << 13, 1 << 13);
    145 
    146 	textram(vh);
    147 	splx(s);
    148 }
    149 #endif
    150 
    151 void
    152 vga_setfontset(struct vga_handle *vh, int fontset1, int fontset2)
    153 {
    154 	u_int8_t cmap;
    155 	static const u_int8_t cmaptaba[] = {
    156 		0x00, 0x10, 0x01, 0x11,
    157 		0x02, 0x12, 0x03, 0x13
    158 	};
    159 	static const u_int8_t cmaptabb[] = {
    160 		0x00, 0x20, 0x04, 0x24,
    161 		0x08, 0x28, 0x0c, 0x2c
    162 	};
    163 
    164 	/* extended font if fontset1 != fontset2 */
    165 	cmap = cmaptaba[fontset1] | cmaptabb[fontset2];
    166 
    167 	vga_ts_write(vh, fontsel, cmap);
    168 }
    169 
    170 void
    171 vga_setscreentype(struct vga_handle *vh, const struct wsscreen_descr *type)
    172 {
    173 
    174 	vga_6845_write(vh, maxrow, type->fontheight - 1);
    175 
    176 	/* lo byte */
    177 	vga_6845_write(vh, vde, type->fontheight * type->nrows - 1);
    178 
    179 #ifndef PCDISPLAY_SOFTCURSOR
    180 	/* set cursor to last 2 lines */
    181 	vga_6845_write(vh, curstart, type->fontheight - 2);
    182 	vga_6845_write(vh, curend, type->fontheight - 1);
    183 #endif
    184 	/*
    185 	 * disable colour plane 3 if needed for font selection
    186 	 */
    187 	if (type->capabilities & WSSCREEN_HILIT) {
    188 		/*
    189 		 * these are the screens which don't support
    190 		 * 512-character fonts
    191 		 */
    192 		vga_attr_write(vh, colplen, 0x0f);
    193 	} else
    194 		vga_attr_write(vh, colplen, 0x07);
    195 }
    196 
    197 #else /* !VGA_RASTERCONSOLE */
    198 void
    199 vga_load_builtinfont(struct vga_handle *vh, u_int8_t *font, int firstchar,
    200 	int numchars)
    201 {
    202 	int i, s;
    203 
    204 	s = splhigh();
    205 	fontram(vh);
    206 
    207 	for (i = firstchar; i < firstchar + numchars; i++)
    208 		bus_space_read_region_1(vh->vh_memt, vh->vh_allmemh, i * 32,
    209 		    font + i * 16, 16);
    210 
    211 	textram(vh);
    212 	splx(s);
    213 }
    214 #endif /* !VGA_RASTERCONSOLE */
    215