1 /* $NetBSD: rasops1.c,v 1.20 2009/03/14 21:04:22 dsl 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: rasops1.c,v 1.20 2009/03/14 21:04:22 dsl 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 rasops1_copycols(void *, int, int, int, int); 48 static void rasops1_erasecols(void *, int, int, int, long); 49 static void rasops1_do_cursor(struct rasops_info *); 50 static void rasops1_putchar(void *, int, int col, u_int, long); 51 #ifndef RASOPS_SMALL 52 static void rasops1_putchar8(void *, int, int col, u_int, long); 53 static void rasops1_putchar16(void *, int, int col, u_int, long); 54 #endif 55 56 /* 57 * Initialize rasops_info struct for this colordepth. 58 */ 59 void 60 rasops1_init(struct rasops_info *ri) 61 { 62 63 switch (ri->ri_font->fontwidth) { 64 #ifndef RASOPS_SMALL 65 case 8: 66 ri->ri_ops.putchar = rasops1_putchar8; 67 break; 68 case 16: 69 ri->ri_ops.putchar = rasops1_putchar16; 70 break; 71 #endif 72 default: 73 ri->ri_ops.putchar = rasops1_putchar; 74 break; 75 } 76 77 if ((ri->ri_font->fontwidth & 7) != 0) { 78 ri->ri_ops.erasecols = rasops1_erasecols; 79 ri->ri_ops.copycols = rasops1_copycols; 80 ri->ri_do_cursor = rasops1_do_cursor; 81 } 82 } 83 84 /* 85 * Paint a single character. This is the generic version, this is ugly. 86 */ 87 static void 88 rasops1_putchar(void *cookie, int row, int col, u_int uc, long attr) 89 { 90 u_int fs, rs, fb, bg, fg, lmask, rmask; 91 u_int32_t height, width; 92 struct rasops_info *ri; 93 int32_t *rp; 94 u_char *fr; 95 96 ri = (struct rasops_info *)cookie; 97 98 #ifdef RASOPS_CLIPPING 99 /* Catches 'row < 0' case too */ 100 if ((unsigned)row >= (unsigned)ri->ri_rows) 101 return; 102 103 if ((unsigned)col >= (unsigned)ri->ri_cols) 104 return; 105 #endif 106 107 col *= ri->ri_font->fontwidth; 108 rp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale + ((col >> 3) & ~3)); 109 height = ri->ri_font->fontheight; 110 width = ri->ri_font->fontwidth; 111 col = col & 31; 112 rs = ri->ri_stride; 113 114 bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 115 fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 116 117 /* If fg and bg match this becomes a space character */ 118 if (fg == bg || uc == ' ') { 119 uc = (u_int)-1; 120 fr = 0; /* shutup gcc */ 121 fs = 0; /* shutup gcc */ 122 } else { 123 uc -= ri->ri_font->firstchar; 124 fr = (u_char *)ri->ri_font->data + uc * ri->ri_fontscale; 125 fs = ri->ri_font->stride; 126 } 127 128 /* Single word, one mask */ 129 if ((col + width) <= 32) { 130 rmask = rasops_pmask[col][width]; 131 lmask = ~rmask; 132 133 if (uc == (u_int)-1) { 134 bg &= rmask; 135 136 while (height--) { 137 *rp = (*rp & lmask) | bg; 138 DELTA(rp, rs, int32_t *); 139 } 140 } else { 141 /* NOT fontbits if bg is white */ 142 if (bg) { 143 while (height--) { 144 fb = ~(fr[3] | (fr[2] << 8) | 145 (fr[1] << 16) | (fr[0] << 24)); 146 *rp = (*rp & lmask) 147 | (MBE(fb >> col) & rmask); 148 149 fr += fs; 150 DELTA(rp, rs, int32_t *); 151 } 152 } else { 153 while (height--) { 154 fb = (fr[3] | (fr[2] << 8) | 155 (fr[1] << 16) | (fr[0] << 24)); 156 *rp = (*rp & lmask) 157 | (MBE(fb >> col) & rmask); 158 159 fr += fs; 160 DELTA(rp, rs, int32_t *); 161 } 162 } 163 } 164 165 /* Do underline */ 166 if ((attr & 1) != 0) { 167 DELTA(rp, -(ri->ri_stride << 1), int32_t *); 168 *rp = (*rp & lmask) | (fg & rmask); 169 } 170 } else { 171 lmask = ~rasops_lmask[col]; 172 rmask = ~rasops_rmask[(col + width) & 31]; 173 174 if (uc == (u_int)-1) { 175 width = bg & ~rmask; 176 bg = bg & ~lmask; 177 178 while (height--) { 179 rp[0] = (rp[0] & lmask) | bg; 180 rp[1] = (rp[1] & rmask) | width; 181 DELTA(rp, rs, int32_t *); 182 } 183 } else { 184 width = 32 - col; 185 186 /* NOT fontbits if bg is white */ 187 if (bg) { 188 while (height--) { 189 fb = ~(fr[3] | (fr[2] << 8) | 190 (fr[1] << 16) | (fr[0] << 24)); 191 192 rp[0] = (rp[0] & lmask) 193 | MBE((u_int)fb >> col); 194 195 rp[1] = (rp[1] & rmask) 196 | (MBE((u_int)fb << width) & ~rmask); 197 198 fr += fs; 199 DELTA(rp, rs, int32_t *); 200 } 201 } else { 202 while (height--) { 203 fb = (fr[3] | (fr[2] << 8) | 204 (fr[1] << 16) | (fr[0] << 24)); 205 206 rp[0] = (rp[0] & lmask) 207 | MBE(fb >> col); 208 209 rp[1] = (rp[1] & rmask) 210 | (MBE(fb << width) & ~rmask); 211 212 fr += fs; 213 DELTA(rp, rs, int32_t *); 214 } 215 } 216 } 217 218 /* Do underline */ 219 if ((attr & 1) != 0) { 220 DELTA(rp, -(ri->ri_stride << 1), int32_t *); 221 rp[0] = (rp[0] & lmask) | (fg & ~lmask); 222 rp[1] = (rp[1] & rmask) | (fg & ~rmask); 223 } 224 } 225 } 226 227 #ifndef RASOPS_SMALL 228 /* 229 * Paint a single character. This is for 8-pixel wide fonts. 230 */ 231 static void 232 rasops1_putchar8(void *cookie, int row, int col, u_int uc, long attr) 233 { 234 int height, fs, rs, bg, fg; 235 struct rasops_info *ri; 236 u_char *fr, *rp; 237 238 ri = (struct rasops_info *)cookie; 239 240 #ifdef RASOPS_CLIPPING 241 /* Catches 'row < 0' case too */ 242 if ((unsigned)row >= (unsigned)ri->ri_rows) 243 return; 244 245 if ((unsigned)col >= (unsigned)ri->ri_cols) 246 return; 247 #endif 248 249 rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale; 250 height = ri->ri_font->fontheight; 251 rs = ri->ri_stride; 252 253 bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 254 fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 255 256 /* If fg and bg match this becomes a space character */ 257 if (fg == bg || uc == ' ') { 258 while (height--) { 259 *rp = bg; 260 rp += rs; 261 } 262 } else { 263 uc -= ri->ri_font->firstchar; 264 fr = (u_char *)ri->ri_font->data + uc * ri->ri_fontscale; 265 fs = ri->ri_font->stride; 266 267 /* NOT fontbits if bg is white */ 268 if (bg) { 269 while (height--) { 270 *rp = ~*fr; 271 fr += fs; 272 rp += rs; 273 } 274 } else { 275 while (height--) { 276 *rp = *fr; 277 fr += fs; 278 rp += rs; 279 } 280 } 281 282 } 283 284 /* Do underline */ 285 if ((attr & 1) != 0) 286 rp[-(ri->ri_stride << 1)] = fg; 287 } 288 289 /* 290 * Paint a single character. This is for 16-pixel wide fonts. 291 */ 292 static void 293 rasops1_putchar16(void *cookie, int row, int col, u_int uc, long attr) 294 { 295 int height, fs, rs, bg, fg; 296 struct rasops_info *ri; 297 u_char *fr, *rp; 298 299 ri = (struct rasops_info *)cookie; 300 301 #ifdef RASOPS_CLIPPING 302 /* Catches 'row < 0' case too */ 303 if ((unsigned)row >= (unsigned)ri->ri_rows) 304 return; 305 306 if ((unsigned)col >= (unsigned)ri->ri_cols) 307 return; 308 #endif 309 310 rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale; 311 height = ri->ri_font->fontheight; 312 rs = ri->ri_stride; 313 314 bg = (attr & 0x000f0000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 315 fg = (attr & 0x0f000000) ? ri->ri_devcmap[1] : ri->ri_devcmap[0]; 316 317 /* If fg and bg match this becomes a space character */ 318 if (fg == bg || uc == ' ') { 319 while (height--) { 320 *(int16_t *)rp = bg; 321 rp += rs; 322 } 323 } else { 324 uc -= ri->ri_font->firstchar; 325 fr = (u_char *)ri->ri_font->data + uc * ri->ri_fontscale; 326 fs = ri->ri_font->stride; 327 328 /* NOT fontbits if bg is white */ 329 if (bg) { 330 while (height--) { 331 rp[0] = ~fr[0]; 332 rp[1] = ~fr[1]; 333 fr += fs; 334 rp += rs; 335 } 336 } else { 337 while (height--) { 338 rp[0] = fr[0]; 339 rp[1] = fr[1]; 340 fr += fs; 341 rp += rs; 342 } 343 } 344 } 345 346 /* Do underline */ 347 if ((attr & 1) != 0) 348 *(int16_t *)(rp - (ri->ri_stride << 1)) = fg; 349 } 350 #endif /* !RASOPS_SMALL */ 351 352 /* 353 * Grab routines common to depths where (bpp < 8) 354 */ 355 #define NAME(ident) rasops1_##ident 356 #define PIXEL_SHIFT 0 357 358 #include <dev/rasops/rasops_bitops.h> 359