cons_fb.c revision 1.1.18.2
1 1.1.18.2 yamt /* $NetBSD: cons_fb.c,v 1.1.18.2 2006/06/21 14:51:20 yamt Exp $ */ 2 1.1.18.2 yamt 3 1.1.18.2 yamt /*- 4 1.1.18.2 yamt * Copyright (c) 2004 The NetBSD Foundation, Inc. 5 1.1.18.2 yamt * All rights reserved. 6 1.1.18.2 yamt * 7 1.1.18.2 yamt * This code is derived from software contributed to The NetBSD Foundation 8 1.1.18.2 yamt * by UCHIYAMA Yasushi. 9 1.1.18.2 yamt * 10 1.1.18.2 yamt * Redistribution and use in source and binary forms, with or without 11 1.1.18.2 yamt * modification, are permitted provided that the following conditions 12 1.1.18.2 yamt * are met: 13 1.1.18.2 yamt * 1. Redistributions of source code must retain the above copyright 14 1.1.18.2 yamt * notice, this list of conditions and the following disclaimer. 15 1.1.18.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 16 1.1.18.2 yamt * notice, this list of conditions and the following disclaimer in the 17 1.1.18.2 yamt * documentation and/or other materials provided with the distribution. 18 1.1.18.2 yamt * 3. All advertising materials mentioning features or use of this software 19 1.1.18.2 yamt * must display the following acknowledgement: 20 1.1.18.2 yamt * This product includes software developed by the NetBSD 21 1.1.18.2 yamt * Foundation, Inc. and its contributors. 22 1.1.18.2 yamt * 4. Neither the name of The NetBSD Foundation nor the names of its 23 1.1.18.2 yamt * contributors may be used to endorse or promote products derived 24 1.1.18.2 yamt * from this software without specific prior written permission. 25 1.1.18.2 yamt * 26 1.1.18.2 yamt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 1.1.18.2 yamt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 1.1.18.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 1.1.18.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 1.1.18.2 yamt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 1.1.18.2 yamt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 1.1.18.2 yamt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 1.1.18.2 yamt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 1.1.18.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 1.1.18.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 1.1.18.2 yamt * POSSIBILITY OF SUCH DAMAGE. 37 1.1.18.2 yamt */ 38 1.1.18.2 yamt 39 1.1.18.2 yamt #include <sys/param.h> 40 1.1.18.2 yamt #include <sys/systm.h> 41 1.1.18.2 yamt 42 1.1.18.2 yamt #include <lib/libsa/stand.h> 43 1.1.18.2 yamt #include <lib/libkern/libkern.h> 44 1.1.18.2 yamt 45 1.1.18.2 yamt #include <machine/sbd.h> 46 1.1.18.2 yamt 47 1.1.18.2 yamt #include "console.h" 48 1.1.18.2 yamt 49 1.1.18.2 yamt struct fb fb; 50 1.1.18.2 yamt 51 1.1.18.2 yamt void 52 1.1.18.2 yamt fb_set_addr(uint32_t fb_addr, uint32_t fb_size, uint32_t font_addr) 53 1.1.18.2 yamt { 54 1.1.18.2 yamt 55 1.1.18.2 yamt fb.fb_addr = (uint8_t *)fb_addr; 56 1.1.18.2 yamt fb.fb_size = fb_size; 57 1.1.18.2 yamt fb.font_addr = (uint8_t *)font_addr; 58 1.1.18.2 yamt 59 1.1.18.2 yamt cons.init = fb_init; 60 1.1.18.2 yamt cons.putc = fb_drawchar; 61 1.1.18.2 yamt cons.scroll = fb_scroll; 62 1.1.18.2 yamt cons.cursor = fb_drawcursor; 63 1.1.18.2 yamt } 64 1.1.18.2 yamt 65 1.1.18.2 yamt void * 66 1.1.18.2 yamt fb_get_addr(void) 67 1.1.18.2 yamt { 68 1.1.18.2 yamt 69 1.1.18.2 yamt return fb.fb_addr; 70 1.1.18.2 yamt } 71 1.1.18.2 yamt 72 1.1.18.2 yamt void 73 1.1.18.2 yamt fb_init(void) 74 1.1.18.2 yamt { 75 1.1.18.2 yamt 76 1.1.18.2 yamt cons.x = X_INIT; 77 1.1.18.2 yamt cons.y = Y_INIT; 78 1.1.18.2 yamt fb.active = TRUE; 79 1.1.18.2 yamt fb_clear(0, 0, FB_WIDTH, FB_HEIGHT, CONS_BG); 80 1.1.18.2 yamt } 81 1.1.18.2 yamt 82 1.1.18.2 yamt void 83 1.1.18.2 yamt fb_active(boolean_t on) 84 1.1.18.2 yamt { 85 1.1.18.2 yamt 86 1.1.18.2 yamt if (fb.active && !on) 87 1.1.18.2 yamt printf("FB disabled.\n"); 88 1.1.18.2 yamt 89 1.1.18.2 yamt fb.active = on; 90 1.1.18.2 yamt 91 1.1.18.2 yamt if (fb.active && on) 92 1.1.18.2 yamt printf("FB enabled.\n"); 93 1.1.18.2 yamt } 94 1.1.18.2 yamt 95 1.1.18.2 yamt void 96 1.1.18.2 yamt fb_scroll(void) 97 1.1.18.2 yamt { 98 1.1.18.2 yamt 99 1.1.18.2 yamt if (!fb.active) 100 1.1.18.2 yamt return; 101 1.1.18.2 yamt #if 0 /* 1-line scroll */ 102 1.1.18.2 yamt cons.y--; 103 1.1.18.2 yamt fb_copy(0, ROM_FONT_HEIGHT, 0, 0, 104 1.1.18.2 yamt FB_WIDTH, FB_HEIGHT * (CONS_HEIGHT - 1)); 105 1.1.18.2 yamt fb_clear(0, cons.y * ROM_FONT_HEIGHT, FB_WIDTH, ROM_FONT_HEIGHT, 106 1.1.18.2 yamt CONS_BG); 107 1.1.18.2 yamt #else /* jump scroll */ 108 1.1.18.2 yamt cons.y /= 2; 109 1.1.18.2 yamt fb_copy(0, cons.y * ROM_FONT_HEIGHT, 0, 0, FB_WIDTH, FB_HEIGHT / 2); 110 1.1.18.2 yamt fb_clear(0, cons.y *ROM_FONT_HEIGHT, FB_WIDTH, FB_HEIGHT / 2, CONS_BG); 111 1.1.18.2 yamt #endif 112 1.1.18.2 yamt } 113 1.1.18.2 yamt 114 1.1.18.2 yamt #define MINMAX(x, min, max) \ 115 1.1.18.2 yamt ((x) < (min) ? (min) : ((x) > (max) ? (max) : (x))) 116 1.1.18.2 yamt void 117 1.1.18.2 yamt fb_clear(int x, int y, int w, int h, int q) 118 1.1.18.2 yamt { 119 1.1.18.2 yamt uint8_t *p; 120 1.1.18.2 yamt int i, j, k, xend, yend; 121 1.1.18.2 yamt 122 1.1.18.2 yamt if (!fb.active) 123 1.1.18.2 yamt return; 124 1.1.18.2 yamt 125 1.1.18.2 yamt x = MINMAX(x, 0, FB_WIDTH); 126 1.1.18.2 yamt y = MINMAX(y, 0, FB_HEIGHT); 127 1.1.18.2 yamt xend = MINMAX(x + w, 0, FB_WIDTH); 128 1.1.18.2 yamt yend = MINMAX(y + h , 0, FB_HEIGHT); 129 1.1.18.2 yamt 130 1.1.18.2 yamt p = (uint8_t *)fb.fb_addr + x + y * FB_LINEBYTES; 131 1.1.18.2 yamt 132 1.1.18.2 yamt j = xend - x; 133 1.1.18.2 yamt k = j + FB_LINEBYTES - w; 134 1.1.18.2 yamt for (i = y; i < yend; i++, p+= k) 135 1.1.18.2 yamt memset(p, q, j); 136 1.1.18.2 yamt } 137 1.1.18.2 yamt 138 1.1.18.2 yamt void 139 1.1.18.2 yamt fb_copy(int x0, int y0, int x1, int y1, int w, int h) 140 1.1.18.2 yamt { 141 1.1.18.2 yamt int x1end, y1end, i, j, k; 142 1.1.18.2 yamt uint8_t *p, *q; 143 1.1.18.2 yamt 144 1.1.18.2 yamt if (!fb.active) 145 1.1.18.2 yamt return; 146 1.1.18.2 yamt 147 1.1.18.2 yamt x0 = MINMAX(x0, 0, FB_WIDTH); 148 1.1.18.2 yamt y0 = MINMAX(y0, 0, FB_HEIGHT); 149 1.1.18.2 yamt x1 = MINMAX(x1, 0, FB_WIDTH); 150 1.1.18.2 yamt y1 = MINMAX(y1, 0, FB_HEIGHT); 151 1.1.18.2 yamt x1end = MINMAX(x1 + w, 0, FB_WIDTH); 152 1.1.18.2 yamt y1end = MINMAX(y1 + h, 0, FB_HEIGHT); 153 1.1.18.2 yamt 154 1.1.18.2 yamt p = fb.fb_addr + x1 + y1 * FB_LINEBYTES; 155 1.1.18.2 yamt q = fb.fb_addr + x0 + y0 * FB_LINEBYTES; 156 1.1.18.2 yamt 157 1.1.18.2 yamt j = x1end - x1; 158 1.1.18.2 yamt k = j + FB_LINEBYTES - w; 159 1.1.18.2 yamt for (i = y1; i < y1end; i++, p += k, q += k) 160 1.1.18.2 yamt memmove(p, q, j); 161 1.1.18.2 yamt } 162 1.1.18.2 yamt #undef MINMAX 163 1.1.18.2 yamt 164 1.1.18.2 yamt void 165 1.1.18.2 yamt fb_drawchar(int x, int y, int c) 166 1.1.18.2 yamt { 167 1.1.18.2 yamt uint16_t *font_addr; 168 1.1.18.2 yamt int font_ofs; 169 1.1.18.2 yamt 170 1.1.18.2 yamt if (!fb.active) 171 1.1.18.2 yamt return; 172 1.1.18.2 yamt 173 1.1.18.2 yamt if ((font_ofs = (c & 0x7f) - 0x20) < 0) 174 1.1.18.2 yamt return; 175 1.1.18.2 yamt 176 1.1.18.2 yamt font_addr = (uint16_t *)(fb.font_addr + 177 1.1.18.2 yamt font_ofs * sizeof(uint16_t) * ROM_FONT_HEIGHT); 178 1.1.18.2 yamt 179 1.1.18.2 yamt fb_drawfont(x, y, font_addr); 180 1.1.18.2 yamt } 181 1.1.18.2 yamt 182 1.1.18.2 yamt void 183 1.1.18.2 yamt fb_drawfont(int x, int y, uint16_t *font_addr) 184 1.1.18.2 yamt { 185 1.1.18.2 yamt uint8_t *fb_addr; 186 1.1.18.2 yamt uint16_t bitmap; 187 1.1.18.2 yamt int i, j; 188 1.1.18.2 yamt 189 1.1.18.2 yamt if (!fb.active) 190 1.1.18.2 yamt return; 191 1.1.18.2 yamt 192 1.1.18.2 yamt fb_addr = fb.fb_addr + x + y * FB_LINEBYTES; 193 1.1.18.2 yamt 194 1.1.18.2 yamt for (i = 0; i < 24; i++) { 195 1.1.18.2 yamt bitmap = *font_addr++; 196 1.1.18.2 yamt for (j = 0; j < 12; j++, bitmap <<= 1) 197 1.1.18.2 yamt fb_addr[j] = bitmap & 0x8000 ? CONS_FG : CONS_BG; 198 1.1.18.2 yamt fb_addr += FB_LINEBYTES; 199 1.1.18.2 yamt } 200 1.1.18.2 yamt } 201 1.1.18.2 yamt 202 1.1.18.2 yamt void 203 1.1.18.2 yamt fb_drawcursor(int x, int y) 204 1.1.18.2 yamt { 205 1.1.18.2 yamt uint8_t *fb_addr; 206 1.1.18.2 yamt int i, j; 207 1.1.18.2 yamt 208 1.1.18.2 yamt if (!fb.active) 209 1.1.18.2 yamt return; 210 1.1.18.2 yamt 211 1.1.18.2 yamt fb_addr = fb.fb_addr + x + y * FB_LINEBYTES; 212 1.1.18.2 yamt for (i = 0; i < 24; i++) { 213 1.1.18.2 yamt for (j = 0; j < 12; j++) 214 1.1.18.2 yamt fb_addr[j] = fb_addr[j] == CONS_FG ? CONS_BG : CONS_FG; 215 1.1.18.2 yamt fb_addr += FB_LINEBYTES; 216 1.1.18.2 yamt } 217 1.1.18.2 yamt } 218
Indexes created Tue Oct 28 12:10:06 GMT 2025