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

... / ...

Commit	Line	Data
	1	#include <io.h>
	2	#include <smram.h>
	3	#include <video_defines.h>
	4	#include <minilib.h>
	5	#include <smi.h>
	6	#include "vga-overlay.h"
	7
	8	unsigned int counter = 0;
	9	unsigned long pcisave;
	10	unsigned char vgasave;
	11
	12	void pci_dump() {
	13	unsigned long cts;
	14	static int curdev = 0; /* 0 if kbd, 1 if mouse */
	15
	16	cts = inl(0x84C);
	17
	18	outl(0x848, 0x0);
	19	outl(0x840, 0x0);
	20	switch(cts&0xF0000)
	21	{
	22	case 0x20000:
	23	{
	24	unsigned char b;
	25	b = inb(cts & 0xFFFF);
	26	dologf("READ: %08x (%02x)", cts, b);
	27	if ((cts & 0xFFFF) == 0x64)
	28	curdev = (b & 0x20) ? 1 : 0;
	29	if ((curdev == 0) && ((cts & 0xFFFF) == 0x60) && (b == 0x01))
	30	outb(0xCF9, 0x4);
	31	(unsigned char)0xAFFD0 /* EAX */ = b;
	32	break;
	33	}
	34	case 0x30000:
	35	{
	36	unsigned char b;
	37
	38	b = (unsigned char)0xAFFD0 /* EAX */;
	39	dologf("WRITE: %08x (%02x)", cts, b);
	40	outb(cts & 0xFFFF, b);
	41	break;
	42	}
	43	default:
	44	dolog("Unhandled PCI cycle");
	45	}
	46
	47	outl(0x848, 0x1000);
	48	outl(0x840, 0x0100);
	49	}
	50
	51	void timer_handler(smi_event_t ev)
	52	{
	53	static unsigned int ticks = 0;
	54
	55	smi_disable_event(SMI_EVENT_FAST_TIMER);
	56	smi_enable_event(SMI_EVENT_FAST_TIMER);
	57
	58	outb(0x80, (ticks++) & 0xFF);
	59
	60	outlog();
	61	}
	62
	63	void kbc_handler(smi_event_t ev)
	64	{
	65	pci_dump();
	66	}
	67
	68	void smi_entry(void)
	69	{
	70	char statstr[512];
	71
	72	pcisave = inl(0xCF8);
	73	vgasave = inb(0x3D4);
	74
	75	counter++;
	76	sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
	77	strblit(statstr, 0, 0);
	78
	79	if (inl(0x840) & 0x1000)
	80	{
	81	pci_dump();
	82	outl(0x840, 0x1100);
	83	outl(0x840, 0x0100);
	84	}
	85
	86	smi_poll();
	87
	88	outl(0xCF8, pcisave);
	89	outb(0x3D4, vgasave);
	90	}
	91