1 /* $NetBSD: rasops4.c,v 1.11 2013/04/21 04:28:05 kiyohara Exp $ */ 2 3 /*- 4 * Copyright (c) 1999 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Andrew Doran. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <sys/cdefs.h> 33 __KERNEL_RCSID(0, "$NetBSD: rasops4.c,v 1.11 2013/04/21 04:28:05 kiyohara Exp $"); 34 35 #include "opt_rasops.h" 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/time.h> 40 #include <machine/endian.h> 41 42 #include <dev/wscons/wsdisplayvar.h> 43 #include <dev/wscons/wsconsio.h> 44 #include <dev/rasops/rasops.h> 45 #include <dev/rasops/rasops_masks.h> 46 47 static void rasops4_copycols(void *, int, int, int, int); 48 static void rasops4_erasecols(void *, int, int, int, long); 49 static void rasops4_do_cursor(struct rasops_info *); 50 static void rasops4_putchar(void *, int, int col, u_int, long); 51 #ifndef RASOPS_SMALL 52 static void rasops4_putchar8(void *, int, int col, u_int, long); 53 static void rasops4_putchar12(void *, int, int col, u_int, long); 54 static void rasops4_putchar16(void *, int, int col, u_int, long); 55 static void rasops4_makestamp(struct rasops_info *, long); 56 57 /* 58 * 4x1 stamp for optimized character blitting 59 */ 60 static u_int16_t stamp[16]; 61 static long stamp_attr; 62 static int stamp_mutex; /* XXX see note in README */ 63 #endif 64 65 /* 66 * Initialize rasops_info struct for this colordepth. 67 */ 68 void 69 rasops4_init(struct rasops_info *ri) 70 { 71 72 switch (ri->ri_font->fontwidth) { 73 #ifndef RASOPS_SMALL 74 case 8: 75 ri->ri_ops.putchar = rasops4_putchar8; 76 break; 77 case 12: 78 ri->ri_ops.putchar = rasops4_putchar12; 79 break; 80 case 16: 81 ri->ri_ops.putchar = rasops4_putchar16; 82 break; 83 #endif /* !RASOPS_SMALL */ 84 default: 85 panic("fontwidth not 8/12/16 or RASOPS_SMALL - fixme!"); 86 ri->ri_ops.putchar = rasops4_putchar; 87 break; 88 } 89 90 if ((ri->ri_font->fontwidth & 1) != 0) { 91 ri->ri_ops.erasecols = rasops4_erasecols; 92 ri->ri_ops.copycols = rasops4_copycols; 93 ri->ri_do_cursor = rasops4_do_cursor; 94 } 95 } 96 97 #ifdef notyet 98 /* 99 * Paint a single character. This is the generic version, this is ugly. 100 */ 101 static void 102 rasops4_putchar(void *cookie, int row, int col, u_int uc, long attr) 103 { 104 int height, width, fs, rs, fb, bg, fg, lmask, rmask; 105 struct rasops_info *ri = (struct rasops_info *)cookie; 106 struct wsdisplay_font *font = PICK_FONT(ri, uc); 107 int32_t *rp; 108 u_char *fr; 109 110 #ifdef RASOPS_CLIPPING 111 /* Catches 'row < 0' case too */ 112 if ((unsigned)row >= (unsigned)ri->ri_rows) 113 return; 114 115 if ((unsigned)col >= (unsigned)ri->ri_cols) 116 return; 117 #endif 118 119 width = font->fontwidth << 1; 120 height = font->fontheight; 121 col *= width; 122 rp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale + ((col >> 3) & ~3)); 123 col = col & 31; 124 rs = ri->ri_stride; 125 126 bg = ri->ri_devcmap[(attr >> 16) & 0xf]; 127 fg = ri->ri_devcmap[(attr >> 24) & 0xf]; 128 129 /* If fg and bg match this becomes a space character */ 130 if (fg == bg || uc == ' ') { 131 uc = (u_int)-1; 132 fr = 0; /* shutup gcc */ 133 fs = 0; /* shutup gcc */ 134 } else { 135 uc -= font->firstchar; 136 fr = (u_char *)font->data + uc * ri->ri_fontscale; 137 fs = font->stride; 138 } 139 140 /* Single word, one mask */ 141 if ((col + width) <= 32) { 142 rmask = rasops_pmask[col][width]; 143 lmask = ~rmask; 144 145 if (uc == (u_int)-1) { 146 bg &= rmask; 147 148 while (height--) { 149 *rp = (*rp & lmask) | bg; 150 DELTA(rp, rs, int32_t *); 151 } 152 } else { 153 while (height--) { 154 /* get bits, mask */ 155 /* compose sl */ 156 /* mask sl */ 157 /* put word */ 158 } 159 } 160 161 /* Do underline */ 162 if (attr & 1) { 163 DELTA(rp, -(ri->ri_stride << 1), int32_t *); 164 *rp = (*rp & lmask) | (fg & rmask); 165 } 166 } else { 167 lmask = ~rasops_lmask[col]; 168 rmask = ~rasops_rmask[(col + width) & 31]; 169 170 if (uc == (u_int)-1) { 171 bg = bg & ~lmask; 172 width = bg & ~rmask; 173 174 while (height--) { 175 rp[0] = (rp[0] & lmask) | bg; 176 rp[1] = (rp[1] & rmask) | width; 177 DELTA(rp, rs, int32_t *); 178 } 179 } else { 180 width = 32 - col; 181 182 /* NOT fontbits if bg is white */ 183 while (height--) { 184 fb = ~(fr[3] | (fr[2] << 8) | 185 (fr[1] << 16) | (fr[0] << 24)); 186 187 rp[0] = (rp[0] & lmask) 188 | MBE((u_int)fb >> col); 189 190 rp[1] = (rp[1] & rmask) 191 | (MBE((u_int)fb << width) & ~rmask); 192 193 fr += fs; 194 DELTA(rp, rs, int32_t *); 195 } 196 } 197 198 /* Do underline */ 199 if (attr & 1) { 200 DELTA(rp, -(ri->ri_stride << 1), int32_t *); 201 rp[0] = (rp[0] & lmask) | (fg & ~lmask); 202 rp[1] = (rp[1] & rmask) | (fg & ~rmask); 203 } 204 } 205 } 206 #endif 207 208 /* 209 * Put a single character. This is the generic version. 210 */ 211 static void 212 rasops4_putchar(void *cookie, int row, int col, u_int uc, long attr) 213 { 214 215 /* XXX punt */ 216 } 217 218 #ifndef RASOPS_SMALL 219 /* 220 * Recompute the blitting stamp. 221 */ 222 static void 223 rasops4_makestamp(struct rasops_info *ri, long attr) 224 { 225 int i, fg, bg; 226 227 fg = ri->ri_devcmap[(attr >> 24) & 0xf] & 0xf; 228 bg = ri->ri_devcmap[(attr >> 16) & 0xf] & 0xf; 229 stamp_attr = attr; 230 231 for (i = 0; i < 16; i++) { 232 #if BYTE_ORDER == BIG_ENDIAN 233 #define NEED_LITTLE_ENDIAN_STAMP RI_BSWAP 234 #else 235 #define NEED_LITTLE_ENDIAN_STAMP 0 236 #endif 237 if ((ri->ri_flg & RI_BSWAP) == NEED_LITTLE_ENDIAN_STAMP) { 238 /* little endian */ 239 stamp[i] = (i & 1 ? fg : bg) << 12; 240 stamp[i] |= (i & 2 ? fg : bg) << 8; 241 stamp[i] |= (i & 4 ? fg : bg) << 4; 242 stamp[i] |= (i & 8 ? fg : bg) << 0; 243 } else { 244 /* big endian */ 245 stamp[i] = (i & 1 ? fg : bg) << 8; 246 stamp[i] |= (i & 2 ? fg : bg) << 12; 247 stamp[i] |= (i & 4 ? fg : bg) << 0; 248 stamp[i] |= (i & 8 ? fg : bg) << 4; 249 } 250 } 251 } 252 253 /* 254 * Put a single character. This is for 8-pixel wide fonts. 255 */ 256 static void 257 rasops4_putchar8(void *cookie, int row, int col, u_int uc, long attr) 258 { 259 struct rasops_info *ri = (struct rasops_info *)cookie; 260 struct wsdisplay_font *font = PICK_FONT(ri, uc); 261 int height, fs, rs; 262 u_char *fr; 263 u_int16_t *rp; 264 265 /* Can't risk remaking the stamp if it's already in use */ 266 if (stamp_mutex++) { 267 stamp_mutex--; 268 rasops4_putchar(cookie, row, col, uc, attr); 269 return; 270 } 271 272 #ifdef RASOPS_CLIPPING 273 /* Catches 'row < 0' case too */ 274 if ((unsigned)row >= (unsigned)ri->ri_rows) { 275 stamp_mutex--; 276 return; 277 } 278 279 if ((unsigned)col >= (unsigned)ri->ri_cols) { 280 stamp_mutex--; 281 return; 282 } 283 #endif 284 285 rp = (u_int16_t *)(ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale); 286 height = font->fontheight; 287 rs = ri->ri_stride / sizeof(*rp); 288 289 /* Recompute stamp? */ 290 if (attr != stamp_attr) 291 rasops4_makestamp(ri, attr); 292 293 if (uc == ' ') { 294 u_int16_t c = stamp[0]; 295 while (height--) { 296 rp[0] = c; 297 rp[1] = c; 298 rp += rs; 299 } 300 } else { 301 uc -= font->firstchar; 302 fr = (u_char *)font->data + uc * ri->ri_fontscale; 303 fs = font->stride; 304 305 while (height--) { 306 rp[0] = stamp[(*fr >> 4) & 0xf]; 307 rp[1] = stamp[*fr & 0xf]; 308 fr += fs; 309 rp += rs; 310 } 311 } 312 313 /* Do underline */ 314 if ((attr & 1) != 0) { 315 rp -= (rs << 1); 316 rp[0] = stamp[15]; 317 rp[1] = stamp[15]; 318 } 319 320 stamp_mutex--; 321 } 322 323 /* 324 * Put a single character. This is for 12-pixel wide fonts. 325 */ 326 static void 327 rasops4_putchar12(void *cookie, int row, int col, u_int uc, long attr) 328 { 329 struct rasops_info *ri = (struct rasops_info *)cookie; 330 struct wsdisplay_font *font = PICK_FONT(ri, uc); 331 int height, fs, rs; 332 u_char *fr; 333 u_int16_t *rp; 334 335 /* Can't risk remaking the stamp if it's already in use */ 336 if (stamp_mutex++) { 337 stamp_mutex--; 338 rasops4_putchar(cookie, row, col, uc, attr); 339 return; 340 } 341 342 #ifdef RASOPS_CLIPPING 343 /* Catches 'row < 0' case too */ 344 if ((unsigned)row >= (unsigned)ri->ri_rows) { 345 stamp_mutex--; 346 return; 347 } 348 349 if ((unsigned)col >= (unsigned)ri->ri_cols) { 350 stamp_mutex--; 351 return; 352 } 353 #endif 354 355 rp = (u_int16_t *)(ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale); 356 height = font->fontheight; 357 rs = ri->ri_stride / sizeof(*rp); 358 359 /* Recompute stamp? */ 360 if (attr != stamp_attr) 361 rasops4_makestamp(ri, attr); 362 363 if (uc == ' ') { 364 u_int16_t c = stamp[0]; 365 while (height--) { 366 rp[0] = c; 367 rp[1] = c; 368 rp[2] = c; 369 rp += rs; 370 } 371 } else { 372 uc -= font->firstchar; 373 fr = (u_char *)font->data + uc * ri->ri_fontscale; 374 fs = font->stride; 375 376 while (height--) { 377 rp[0] = stamp[(fr[0] >> 4) & 0xf]; 378 rp[1] = stamp[fr[0] & 0xf]; 379 rp[2] = stamp[(fr[1] >> 4) & 0xf]; 380 fr += fs; 381 rp += rs; 382 } 383 } 384 385 /* Do underline */ 386 if ((attr & 1) != 0) { 387 rp -= (rs << 1); 388 rp[0] = stamp[15]; 389 rp[1] = stamp[15]; 390 rp[2] = stamp[15]; 391 } 392 393 stamp_mutex--; 394 } 395 396 /* 397 * Put a single character. This is for 16-pixel wide fonts. 398 */ 399 static void 400 rasops4_putchar16(void *cookie, int row, int col, u_int uc, long attr) 401 { 402 struct rasops_info *ri = (struct rasops_info *)cookie; 403 struct wsdisplay_font *font = PICK_FONT(ri, uc); 404 int height, fs, rs; 405 u_char *fr; 406 u_int16_t *rp; 407 408 /* Can't risk remaking the stamp if it's already in use */ 409 if (stamp_mutex++) { 410 stamp_mutex--; 411 rasops4_putchar(cookie, row, col, uc, attr); 412 return; 413 } 414 415 #ifdef RASOPS_CLIPPING 416 /* Catches 'row < 0' case too */ 417 if ((unsigned)row >= (unsigned)ri->ri_rows) { 418 stamp_mutex--; 419 return; 420 } 421 422 if ((unsigned)col >= (unsigned)ri->ri_cols) { 423 stamp_mutex--; 424 return; 425 } 426 #endif 427 428 rp = (u_int16_t *)(ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale); 429 height = font->fontheight; 430 rs = ri->ri_stride / sizeof(*rp); 431 432 /* Recompute stamp? */ 433 if (attr != stamp_attr) 434 rasops4_makestamp(ri, attr); 435 436 if (uc == ' ') { 437 u_int16_t c = stamp[0]; 438 while (height--) { 439 rp[0] = c; 440 rp[1] = c; 441 rp[2] = c; 442 rp[3] = c; 443 rp += rs; 444 } 445 } else { 446 uc -= font->firstchar; 447 fr = (u_char *)font->data + uc * ri->ri_fontscale; 448 fs = font->stride; 449 450 while (height--) { 451 rp[0] = stamp[(fr[0] >> 4) & 0xf]; 452 rp[1] = stamp[fr[0] & 0xf]; 453 rp[2] = stamp[(fr[1] >> 4) & 0xf]; 454 rp[3] = stamp[fr[1] & 0xf]; 455 fr += fs; 456 rp += rs; 457 } 458 } 459 460 /* Do underline */ 461 if ((attr & 1) != 0) { 462 rp -= (rs << 1); 463 rp[0] = stamp[15]; 464 rp[1] = stamp[15]; 465 rp[2] = stamp[15]; 466 rp[3] = stamp[15]; 467 } 468 469 stamp_mutex--; 470 } 471 #endif /* !RASOPS_SMALL */ 472 473 /* 474 * Grab routines common to depths where (bpp < 8) 475 */ 476 #define NAME(ident) rasops4_##ident 477 #define PIXEL_SHIFT 3 478 479 #include <dev/rasops/rasops_bitops.h> 480