Joshua Wise's Git repositories - netwatch.git/blame_incremental

... / ...

Commit	Line	Data
	1	#include <io.h>
	2	#include <text.h>
	3	#include <paging.h>
	4	#include <minilib.h>
	5	#include <stdint.h>
	6	#include <output.h>
	7	#include <smram.h>
	8
	9	static unsigned char _font[256 * 32];
	10
	11	/* Must be called from a firstrun context, where we don't care about saving
	12	* 0x3CE state. */
	13	void text_init()
	14	{
	15	unsigned char oldread;
	16	smram_state_t old_state = smram_save_state();
	17	outb(0x3CE, 0x05 /* Mode register */);
	18	outb(0x3CF, inb(0x3CF) & ~(0x10 /* Odd/even */));
	19	outb(0x3CE, 0x04 /* Read register */);
	20	oldread = inb(0x3CF);
	21	outb(0x3CF, 0x02 /* Font plane */);
	22	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
	23	memcpy(_font, p2v(0xB8000), sizeof(_font));
	24	smram_restore_state(old_state);
	25	outb(0x3CF, oldread);
	26	}
	27
	28	void text_render(char *buf, int x, int y, int w, int h)
	29	{
	30	unsigned char video = (unsigned char )0xB8000;
	31	unsigned int textx = x / 9;
	32	unsigned int texty = y / 14;
	33	unsigned int cx, cy;
	34	unsigned char ch, at, font;
	35	smram_state_t old_state = smram_save_state();
	36
	37	outputf("text_render: buf %08x, (%d,%d),(%d,%d)", buf, x, y, w, h);
	38
	39	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
	40	for (cy = y; cy < (y + h); cy++)
	41	{
	42	cx = x;
	43	texty = cy / 14;
	44	textx = cx / 9;
	45	ch = video[texty * 50 + textx * 2];
	46	at = video[texty * 50 + textx * 2 + 1];
	47	font = _font[ch * 32 + cy % 14];
	48	for (cx = x; cx < (x + w); cx++)
	49	{
	50	unsigned int pos = cx % 9;
	51	if (pos == 0)
	52	{
	53	textx = cx / 9;
	54	ch = video[texty * 50 + textx * 2];
	55	at = video[texty * 50 + textx * 2 + 1];
	56	font = _font[ch * 32 + cy % 14];
	57	}
	58	/* XXX always BGR888 */
	59	if (pos == 8) /* 9th pixel is cloned */
	60	pos = 7;
	61	if ((font >> (7 - pos)) & 1)
	62	{
	63	*(buf++) = (at & 0x01) ? 0xFF : 0x00;
	64	*(buf++) = (at & 0x02) ? 0xFF : 0x00;
	65	*(buf++) = (at & 0x04) ? 0xFF : 0x00;
	66	} else {
	67	*(buf++) = (at & 0x10) ? 0xFF : 0x00;
	68	*(buf++) = (at & 0x20) ? 0xFF : 0x00;
	69	*(buf++) = (at & 0x40) ? 0xFF : 0x00;
	70	}
	71	*(buf++) = 0;
	72	}
	73	}
	74	smram_restore_state(old_state);
	75	}
	76
	77	uint32_t text_checksum(int x, int y, int w, int h)
	78	{
	79	unsigned char video = (unsigned char )0xB8000;
	80	unsigned int textx = x / 9;
	81	unsigned int texty = y / 14;
	82	int cx, cy;
	83	unsigned char ch, at;
	84	uint32_t cksm = 0;
	85	smram_state_t old_state = smram_save_state();
	86
	87	outputf("checksum: (%d,%d),(%d,%d)", x,y,w,h);
	88
	89	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
	90
	91	for (cy = y; cy < (y + h); cy++)
	92	{
	93	cx = x;
	94	texty = cy / 14;
	95	textx = cx / 9;
	96	ch = video[texty * 50 + textx * 2];
	97	at = video[texty * 50 + textx * 2 + 1];
	98	for (cx = x; cx < (x + w); cx++)
	99	{
	100	unsigned int pos = cx % 9;
	101	if (pos == 0)
	102	{
	103	textx = cx / 9;
	104	ch = video[texty * 50 + textx * 2];
	105	at = video[texty * 50 + textx * 2 + 1];
	106	}
	107
	108	cksm += ch + (at << 16);
	109	}
	110	}
	111
	112	smram_restore_state(old_state);
	113
	114	outputf("checksum: %08x", cksm);
	115
	116	return cksm;
	117	}