+++ /dev/null
-/* text.c
- * Text console checksum and rendering functions
- * NetWatch system management mode administration console
- *
- * Copyright (c) 2008 Jacob Potter and Joshua Wise. All rights reserved.
- * This program is free software; you can redistribute and/or modify it under
- * the terms found in the file LICENSE in the root of this source tree.
- *
- */
-
-#include <io.h>
-#include <text.h>
-#include <paging.h>
-#include <minilib.h>
-#include <stdint.h>
-#include <output.h>
-#include <smram.h>
-#include <crc32.h>
-#include <video_defines.h>
-
-static unsigned char _font[256 * 32];
-
-/* XXX reunify this with vga-overlay? */
-#define VRAM_BASE 0xA0000UL
-#define TEXT_CONSOLE_OFFSET 0x18000UL
-
-#define TEXT_CONSOLE_BASE (VRAM_BASE + TEXT_CONSOLE_OFFSET)
-
-static unsigned char vga_read(unsigned char idx)
-{
- outb(CRTC_IDX_REG, idx);
- return inb(CRTC_DATA_REG);
-}
-
-static char * vga_base()
-{
- return (char *) (
- TEXT_CONSOLE_BASE
- + (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
- + (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1)
- );
-}
-
-/* Must be called from a firstrun context, where we don't care about saving
- * 0x3CE state. */
-void text_init()
-{
- unsigned char oldread;
-
- smram_state_t old_state = smram_save_state();
- outb(0x3CE, 0x06 /* Miscellaneous */);
- outb(0x3CF, 0x0C);
- outb(0x3C4, 0x04 /* Seq memory mode */);
- outb(0x3C5, inb(0x3C5) | 0x04);
- outb(0x3CE, 0x05 /* Mode */);
- outb(0x3CF, inb(0x3CF) & ~0x10);
- outb(0x3CE, 0x04 /* Read register */);
- oldread = inb(0x3CF);
- outb(0x3CF, 0x02 /* Font plane */);
-
- smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
- memcpy(_font, p2v(0xB8000), sizeof(_font));
- smram_restore_state(old_state);
-
- outb(0x3CF, oldread);
- outb(0x3CE, 0x06 /* Miscellaneous */);
- outb(0x3CF, 0x0E);
- outb(0x3CE, 0x05 /* Mode */);
- outb(0x3CF, inb(0x3CF) | 0x10);
- outb(0x3C4, 0x04 /* Seq memory mode */);
- outb(0x3C5, inb(0x3C5) & ~0x04);
-}
-
-void text_render(char *buf, int x, int y, int w, int h)
-{
- unsigned char *video = (unsigned char *)vga_base();
- unsigned int textx = x / 9;
- unsigned int texty = y / 16;
- unsigned int cx, cy;
- unsigned char ch, at, font;
- smram_state_t old_state = smram_save_state();
-/*
- outputf("text_render: (%d,%d),(%d,%d)", x, y, w, h);
-*/
- smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
- for (cy = y; cy < (y + h); cy++)
- {
- cx = x;
- texty = cy / 16;
- textx = cx / 9;
- ch = video[texty * 160 + textx * 2];
- at = video[texty * 160 + textx * 2 + 1];
- font = _font[ch * 32 + cy % 16];
- for (cx = x; cx < (x + w); cx++)
- {
- unsigned int pos = cx % 8;
- if (pos == 0)
- {
- textx = cx / 8;
- ch = video[texty * 160 + textx * 2];
- at = video[texty * 160 + textx * 2 + 1];
- font = _font[ch * 32 + cy % 16];
- }
- /* XXX always BGR888 */
- if (pos == 8) /* 9th pixel is cloned */
- pos = 7;
- if ((font >> (7 - pos)) & 1)
- {
- *(buf++) = (at & 0x01) ? 0xFF : 0x00;
- *(buf++) = (at & 0x02) ? 0xFF : 0x00;
- *(buf++) = (at & 0x04) ? 0xFF : 0x00;
- } else {
- *(buf++) = (at & 0x10) ? 0xFF : 0x00;
- *(buf++) = (at & 0x20) ? 0xFF : 0x00;
- *(buf++) = (at & 0x40) ? 0xFF : 0x00;
- }
- *(buf++) = 0;
- }
- }
- smram_restore_state(old_state);
-}
-
-uint32_t text_checksum(int x, int y, int w, int h)
-{
- unsigned char *video = (unsigned char *)vga_base();
- unsigned int textx = x / 8;
- unsigned int texty = y / 16;
- int cx, cy;
- uint32_t cksm = 0;
- smram_state_t old_state = smram_save_state();
-
- smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
-
- for (cy = y; cy < (y + h); cy++)
- {
- cx = x;
- texty = cy / 16;
- textx = cx / 8;
- cksm = crc32(video + texty * 160 + textx * 2, (w / 8) * 2 + 2, cksm); /* Err on the side of 'too many'. */
- }
-
- smram_restore_state(old_state);
-
- return cksm;
-}