void
vt_fb_setpixel(struct vt_device *vd, int x, int y, term_color_t color)
{
struct fb_info *info;
uint32_t c;
u_int o;
info = vd->vd_softc;
c = info->fb_cmap[color];
o = info->fb_stride * y + x * FBTYPE_GET_BYTESPP(info);
KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
switch (FBTYPE_GET_BYTESPP(info)) {
case 1:
vt_fb_mem_wr1(info, o, c);
break;
case 2:
vt_fb_mem_wr2(info, o, c);
break;
case 3:
vt_fb_mem_wr1(info, o, (c >> 16) & 0xff);
vt_fb_mem_wr1(info, o + 1, (c >> 8) & 0xff);
vt_fb_mem_wr1(info, o + 2, c & 0xff);
break;
case 4:
vt_fb_mem_wr4(info, o, c);
break;
default:
/* panic? */
return;
}
}
void
vt_fb_blank(struct vt_device *vd, term_color_t color)
{
struct fb_info *info;
uint32_t c;
u_int o, h;
info = vd->vd_softc;
c = info->fb_cmap[color];
if (info->fb_flags & FB_FLAG_NOWRITE)
return;
KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
switch (FBTYPE_GET_BYTESPP(info)) {
case 1:
for (h = 0; h < info->fb_height; h++)
for (o = 0; o < info->fb_stride; o++)
vt_fb_mem_wr1(info, h*info->fb_stride + o, c);
break;
case 2:
for (h = 0; h < info->fb_height; h++)
for (o = 0; o < info->fb_stride; o += 2)
vt_fb_mem_wr2(info, h*info->fb_stride + o, c);
break;
case 3:
for (h = 0; h < info->fb_height; h++)
for (o = 0; o < info->fb_stride; o += 3) {
vt_fb_mem_wr1(info, h*info->fb_stride + o,
(c >> 16) & 0xff);
vt_fb_mem_wr1(info, h*info->fb_stride + o + 1,
(c >> 8) & 0xff);
vt_fb_mem_wr1(info, h*info->fb_stride + o + 2,
c & 0xff);
}
break;
case 4:
for (h = 0; h < info->fb_height; h++)
for (o = 0; o < info->fb_stride; o += 4)
vt_fb_mem_wr4(info, h*info->fb_stride + o, c);
break;
default:
/* panic? */
return;
}
}
void
vt_fb_bitbltchr(struct vt_device *vd, const uint8_t *src, const uint8_t *mask,
int bpl, vt_axis_t top, vt_axis_t left, unsigned int width,
unsigned int height, term_color_t fg, term_color_t bg)
{
struct fb_info *info;
uint32_t fgc, bgc, cc, o;
int c, l, bpp;
u_long line;
uint8_t b, m;
const uint8_t *ch;
info = vd->vd_softc;
bpp = FBTYPE_GET_BYTESPP(info);
fgc = info->fb_cmap[fg];
bgc = info->fb_cmap[bg];
b = m = 0;
if (bpl == 0)
bpl = (width + 7) >> 3; /* Bytes per sorce line. */
/* Don't try to put off screen pixels */
if (((left + width) > info->fb_width) || ((top + height) >
info->fb_height))
return;
KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
line = (info->fb_stride * top) + (left * bpp);
for (l = 0; l < height; l++) {
ch = src;
for (c = 0; c < width; c++) {
if (c % 8 == 0)
b = *ch++;
else
b <<= 1;
if (mask != NULL) {
if (c % 8 == 0)
m = *mask++;
else
m <<= 1;
/* Skip pixel write, if mask has no bit set. */
if ((m & 0x80) == 0)
continue;
}
o = line + (c * bpp);
cc = b & 0x80 ? fgc : bgc;
switch(bpp) {
case 1:
vt_fb_mem_wr1(info, o, cc);
break;
case 2:
vt_fb_mem_wr2(info, o, cc);
break;
case 3:
/* Packed mode, so unaligned. Byte access. */
vt_fb_mem_wr1(info, o, (cc >> 16) & 0xff);
vt_fb_mem_wr1(info, o + 1, (cc >> 8) & 0xff);
vt_fb_mem_wr1(info, o + 2, cc & 0xff);
break;
case 4:
vt_fb_mem_wr4(info, o, cc);
break;
default:
/* panic? */
break;
}
}
line += info->fb_stride;
src += bpl;
}
}
void
vt_fb_bitblt_bitmap(struct vt_device *vd, const struct vt_window *vw,
const uint8_t *pattern, const uint8_t *mask,
unsigned int width, unsigned int height,
unsigned int x, unsigned int y, term_color_t fg, term_color_t bg)
{
struct fb_info *info;
uint32_t fgc, bgc, cc, o;
int bpp, bpl, xi, yi;
int bit, byte;
info = vd->vd_softc;
bpp = FBTYPE_GET_BYTESPP(info);
fgc = info->fb_cmap[fg];
bgc = info->fb_cmap[bg];
bpl = (width + 7) / 8; /* Bytes per source line. */
if (info->fb_flags & FB_FLAG_NOWRITE)
return;
KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
/* Bound by right and bottom edges. */
if (y + height > vw->vw_draw_area.tr_end.tp_row) {
if (y >= vw->vw_draw_area.tr_end.tp_row)
return;
height = vw->vw_draw_area.tr_end.tp_row - y;
}
if (x + width > vw->vw_draw_area.tr_end.tp_col) {
if (x >= vw->vw_draw_area.tr_end.tp_col)
return;
width = vw->vw_draw_area.tr_end.tp_col - x;
}
for (yi = 0; yi < height; yi++) {
for (xi = 0; xi < width; xi++) {
byte = yi * bpl + xi / 8;
bit = 0x80 >> (xi % 8);
/* Skip pixel write, if mask bit not set. */
if (mask != NULL && (mask[byte] & bit) == 0)
continue;
o = (y + yi) * info->fb_stride + (x + xi) * bpp;
o += vd->vd_transpose;
cc = pattern[byte] & bit ? fgc : bgc;
switch(bpp) {
case 1:
vt_fb_mem_wr1(info, o, cc);
break;
case 2:
vt_fb_mem_wr2(info, o, cc);
break;
case 3:
/* Packed mode, so unaligned. Byte access. */
vt_fb_mem_wr1(info, o, (cc >> 16) & 0xff);
vt_fb_mem_wr1(info, o + 1, (cc >> 8) & 0xff);
vt_fb_mem_wr1(info, o + 2, cc & 0xff);
break;
case 4:
vt_fb_mem_wr4(info, o, cc);
break;
default:
/* panic? */
break;
}
}
}
}