1 /* $NetBSD: pcdisplay_subr.c,v 1.34 2007/10/19 11:59:58 ad Exp $ */ 2 3 /* 4 * Copyright (c) 1995, 1996 Carnegie-Mellon University. 5 * All rights reserved. 6 * 7 * Author: Chris G. Demetriou 8 * 9 * Permission to use, copy, modify and distribute this software and 10 * its documentation is hereby granted, provided that both the copyright 11 * notice and this permission notice appear in all copies of the 12 * software, derivative works or modified versions, and any portions 13 * thereof, and that both notices appear in supporting documentation. 14 * 15 * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS" 16 * CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND 17 * FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE. 18 * 19 * Carnegie Mellon requests users of this software to return to 20 * 21 * Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU 22 * School of Computer Science 23 * Carnegie Mellon University 24 * Pittsburgh PA 15213-3890 25 * 26 * any improvements or extensions that they make and grant Carnegie the 27 * rights to redistribute these changes. 28 */ 29 30 #include <sys/cdefs.h> 31 __KERNEL_RCSID(0, "$NetBSD: pcdisplay_subr.c,v 1.34 2007/10/19 11:59:58 ad Exp $"); 32 33 #include "opt_wsmsgattrs.h" /* for WSDISPLAY_CUSTOM_OUTPUT */ 34 35 #include <sys/param.h> 36 #include <sys/systm.h> 37 #include <sys/device.h> 38 #include <sys/bus.h> 39 40 #include <dev/ic/mc6845reg.h> 41 #include <dev/ic/pcdisplayvar.h> 42 #include <dev/wscons/wsconsio.h> 43 44 #include <dev/wscons/wsdisplayvar.h> 45 46 void 47 pcdisplay_cursor_init(struct pcdisplayscreen *scr, int existing) 48 { 49 #ifdef PCDISPLAY_SOFTCURSOR 50 bus_space_tag_t memt; 51 bus_space_handle_t memh; 52 int off; 53 54 pcdisplay_6845_write(scr->hdl, curstart, 0x10); 55 pcdisplay_6845_write(scr->hdl, curend, 0x10); 56 57 if (existing) { 58 /* 59 * This is the first screen. At this point, scr->mem is NULL 60 * (no backing store), so we can't use pcdisplay_cursor() to 61 * do this. 62 */ 63 memt = scr->hdl->ph_memt; 64 memh = scr->hdl->ph_memh; 65 off = (scr->cursorrow * scr->type->ncols + scr->cursorcol) * 2 66 + scr->dispoffset; 67 68 scr->cursortmp = bus_space_read_2(memt, memh, off); 69 bus_space_write_2(memt, memh, off, scr->cursortmp ^ 0x7700); 70 } else 71 scr->cursortmp = 0; 72 #else 73 /* 74 * Firmware might not have initialized the cursor shape. Make 75 * sure there's something we can see. 76 * Don't touch the hardware if this is not the first screen. 77 */ 78 if (existing) { 79 pcdisplay_6845_write(scr->hdl, curstart, 80 scr->type->fontheight - 2); 81 pcdisplay_6845_write(scr->hdl, curend, 82 scr->type->fontheight - 1); 83 } 84 #endif 85 scr->cursoron = 1; 86 } 87 88 void 89 pcdisplay_cursor(void *id, int on, int row, int col) 90 { 91 #ifdef PCDISPLAY_SOFTCURSOR 92 struct pcdisplayscreen *scr = id; 93 bus_space_tag_t memt = scr->hdl->ph_memt; 94 bus_space_handle_t memh = scr->hdl->ph_memh; 95 int off; 96 97 /* Remove old cursor image */ 98 if (scr->cursoron) { 99 off = scr->cursorrow * scr->type->ncols + scr->cursorcol; 100 if (scr->active) 101 bus_space_write_2(memt, memh, scr->dispoffset + off * 2, 102 scr->cursortmp); 103 else 104 scr->mem[off] = scr->cursortmp; 105 } 106 107 scr->cursorrow = row; 108 scr->cursorcol = col; 109 110 if ((scr->cursoron = on) == 0) 111 return; 112 113 off = (scr->cursorrow * scr->type->ncols + scr->cursorcol); 114 if (scr->active) { 115 off = off * 2 + scr->dispoffset; 116 scr->cursortmp = bus_space_read_2(memt, memh, off); 117 bus_space_write_2(memt, memh, off, scr->cursortmp ^ 0x7700); 118 } else { 119 scr->cursortmp = scr->mem[off]; 120 scr->mem[off] = scr->cursortmp ^ 0x7700; 121 } 122 #else /* PCDISPLAY_SOFTCURSOR */ 123 struct pcdisplayscreen *scr = id; 124 int pos; 125 126 scr->cursorrow = row; 127 scr->cursorcol = col; 128 scr->cursoron = on; 129 130 if (scr->active) { 131 if (!on) 132 pos = 0x3fff; 133 else 134 pos = scr->dispoffset / 2 135 + row * scr->type->ncols + col; 136 137 pcdisplay_6845_write(scr->hdl, cursorh, pos >> 8); 138 pcdisplay_6845_write(scr->hdl, cursorl, pos); 139 } 140 #endif /* PCDISPLAY_SOFTCURSOR */ 141 } 142 143 #if 0 144 unsigned int 145 pcdisplay_mapchar_simple(void *id, int uni) 146 { 147 if (uni < 128) 148 return (uni); 149 150 return (1); /* XXX ??? smiley */ 151 } 152 #endif 153 154 void 155 pcdisplay_putchar(void *id, int row, int col, unsigned int c, long attr) 156 { 157 struct pcdisplayscreen *scr = id; 158 bus_space_tag_t memt = scr->hdl->ph_memt; 159 bus_space_handle_t memh = scr->hdl->ph_memh; 160 size_t off; 161 162 off = row * scr->type->ncols + col; 163 164 /* check for bogus row and column sizes */ 165 if (__predict_false(off >= (scr->type->ncols * scr->type->nrows))) 166 return; 167 168 if (scr->active) 169 bus_space_write_2(memt, memh, scr->dispoffset + off * 2, 170 c | (attr << 8)); 171 else 172 scr->mem[off] = c | (attr << 8); 173 174 scr->visibleoffset = scr->dispoffset; 175 } 176 177 void 178 pcdisplay_copycols(void *id, int row, int srccol, int dstcol, int ncols) 179 { 180 struct pcdisplayscreen *scr = id; 181 bus_space_tag_t memt = scr->hdl->ph_memt; 182 bus_space_handle_t memh = scr->hdl->ph_memh; 183 bus_size_t srcoff, dstoff; 184 185 srcoff = dstoff = row * scr->type->ncols; 186 srcoff += srccol; 187 dstoff += dstcol; 188 189 if (scr->active) 190 bus_space_copy_region_2(memt, memh, 191 scr->dispoffset + srcoff * 2, 192 memh, scr->dispoffset + dstoff * 2, 193 ncols); 194 else 195 memcpy(&scr->mem[dstoff], &scr->mem[srcoff], ncols * 2); 196 } 197 198 void 199 pcdisplay_erasecols(void *id, int row, int startcol, int ncols, long fillattr) 200 { 201 struct pcdisplayscreen *scr = id; 202 bus_space_tag_t memt = scr->hdl->ph_memt; 203 bus_space_handle_t memh = scr->hdl->ph_memh; 204 bus_size_t off; 205 u_int16_t val; 206 int i; 207 208 off = row * scr->type->ncols + startcol; 209 210 val = (fillattr << 8) | ' '; 211 212 if (scr->active) 213 bus_space_set_region_2(memt, memh, scr->dispoffset + off * 2, 214 val, ncols); 215 else 216 for (i = 0; i < ncols; i++) 217 scr->mem[off + i] = val; 218 } 219 220 void 221 pcdisplay_copyrows(void *id, int srcrow, int dstrow, int nrows) 222 { 223 struct pcdisplayscreen *scr = id; 224 bus_space_tag_t memt = scr->hdl->ph_memt; 225 bus_space_handle_t memh = scr->hdl->ph_memh; 226 int ncols = scr->type->ncols; 227 bus_size_t srcoff, dstoff; 228 229 srcoff = srcrow * ncols + 0; 230 dstoff = dstrow * ncols + 0; 231 232 if (scr->active) 233 bus_space_copy_region_2(memt, memh, 234 scr->dispoffset + srcoff * 2, 235 memh, scr->dispoffset + dstoff * 2, 236 nrows * ncols); 237 else 238 memcpy(&scr->mem[dstoff], &scr->mem[srcoff], 239 nrows * ncols * 2); 240 } 241 242 void 243 pcdisplay_eraserows(void *id, int startrow, int nrows, long fillattr) 244 { 245 struct pcdisplayscreen *scr = id; 246 bus_space_tag_t memt = scr->hdl->ph_memt; 247 bus_space_handle_t memh = scr->hdl->ph_memh; 248 bus_size_t off, count; 249 u_int16_t val; 250 u_int i; 251 252 off = startrow * scr->type->ncols; 253 count = nrows * scr->type->ncols; 254 255 val = (fillattr << 8) | ' '; 256 257 if (scr->active) 258 bus_space_set_region_2(memt, memh, scr->dispoffset + off * 2, 259 val, count); 260 else 261 for (i = 0; i < count; i++) 262 scr->mem[off + i] = val; 263 } 264 265 #ifdef WSDISPLAY_CUSTOM_OUTPUT 266 void 267 pcdisplay_replaceattr(void *id, long oldattr, long newattr) 268 { 269 struct pcdisplayscreen *scr = id; 270 bus_space_tag_t memt = scr->hdl->ph_memt; 271 bus_space_handle_t memh = scr->hdl->ph_memh; 272 int off; 273 uint16_t chardata; 274 275 if (scr->active) 276 for (off = 0; off < scr->type->nrows * scr->type->ncols; 277 off++) { 278 chardata = bus_space_read_2(memt, memh, 279 scr->dispoffset + off * 2); 280 if ((long)(chardata >> 8) == oldattr) 281 bus_space_write_2(memt, memh, 282 scr->dispoffset + off * 2, 283 ((u_int16_t)(newattr << 8)) | 284 (chardata & 0x00FF)); 285 } 286 else 287 for (off = 0; off < scr->type->nrows * scr->type->ncols; 288 off++) { 289 chardata = scr->mem[off]; 290 if ((long)(chardata >> 8) == oldattr) 291 scr->mem[off] = ((u_int16_t)(newattr << 8)) | 292 (chardata & 0x00FF); 293 } 294 } 295 #endif /* WSDISPLAY_CUSTOM_OUTPUT */ 296 297 int 298 pcdisplay_getwschar(struct pcdisplayscreen *scr, struct wsdisplay_char *wschar) 299 { 300 size_t off; 301 uint16_t chardata; 302 uint8_t attrbyte; 303 304 KASSERT(scr != NULL && wschar != NULL); 305 306 off = wschar->row * scr->type->ncols + wschar->col; 307 if (off >= scr->type->ncols * scr->type->nrows) 308 return -1; 309 310 if (scr->active) 311 chardata = bus_space_read_2(scr->hdl->ph_memt, 312 scr->hdl->ph_memh, scr->dispoffset + off * 2); 313 else 314 chardata = scr->mem[off]; 315 316 wschar->letter = (chardata & 0x00FF); 317 wschar->flags = 0; 318 attrbyte = (chardata & 0xFF00) >> 8; 319 if ((attrbyte & 0x08)) wschar->flags |= WSDISPLAY_CHAR_BRIGHT; 320 if ((attrbyte & 0x80)) wschar->flags |= WSDISPLAY_CHAR_BLINK; 321 wschar->foreground = attrbyte & 0x07; 322 wschar->background = (attrbyte >> 4) & 0x07; 323 324 return 0; 325 } 326 327 int 328 pcdisplay_putwschar(struct pcdisplayscreen *scr, struct wsdisplay_char *wschar) 329 { 330 size_t off; 331 uint16_t chardata; 332 uint8_t attrbyte; 333 334 KASSERT(scr != NULL && wschar != NULL); 335 336 off = wschar->row * scr->type->ncols + wschar->col; 337 if (off >= (scr->type->ncols * scr->type->nrows)) 338 return -1; 339 340 attrbyte = wschar->background & 0x07; 341 if (wschar->flags & WSDISPLAY_CHAR_BLINK) attrbyte |= 0x08; 342 attrbyte <<= 4; 343 attrbyte |= wschar->foreground & 0x07; 344 if (wschar->flags & WSDISPLAY_CHAR_BRIGHT) attrbyte |= 0x08; 345 chardata = (attrbyte << 8) | wschar->letter; 346 347 if (scr->active) 348 bus_space_write_2(scr->hdl->ph_memt, scr->hdl->ph_memh, 349 scr->dispoffset + off * 2, chardata); 350 else 351 scr->mem[off] = chardata; 352 353 return 0; 354 } 355