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 <pci-bother.h>
	7	#include "../net/net.h"
	8	#include "vga-overlay.h"
	9	#include "packet.h"
	10	#include "keyboard.h"
	11
	12	unsigned int counter = 0;
	13	unsigned int lastctr = 0;
	14	unsigned long pcisave;
	15	unsigned char vgasave;
	16	static int curdev = 0; /* 0 if kbd, 1 if mouse */
	17
	18	static void cause_kbd_irq()
	19	{
	20	outl(0x844, 0x0);
	21	outl(0x848, 0x0);
	22	while (inb(0x64) & 0x1)
	23	inb(0x60);
	24	outb(0x60, 0xee); /* Cause an IRQ. */
	25	while (inb(0x60) != 0xEE)
	26	;
	27	}
	28
	29	void pci_dump() {
	30	unsigned long cts;
	31
	32	cts = inl(0x84C);
	33
	34	outl(0x840, 0x0);
	35	outl(0x848, 0x0);
	36	switch(cts&0xF0000)
	37	{
	38	case 0x20000:
	39	{
	40	unsigned char b;
	41
	42	switch (cts & 0xFFFF)
	43	{
	44	case 0x64:
	45	/* Read the real hardware and mask in our OBF if need be. */
	46	b = inb(0x64);
	47	if (kbd_has_injected_scancode())
	48	{
	49	dologf("OS wants to know; we have data");
	50	lastctr = counter;
	51	b \|= 0x01;
	52	b &= ~0x20; /* no mouse for you! */
	53	curdev = 0;
	54	} else
	55	curdev = (b & 0x20) ? 1 : 0;
	56	(unsigned char)0xAFFD0 /* EAX */ = b;
	57	break;
	58	case 0x60:
	59	if (kbd_has_injected_scancode())
	60	{
	61	b = kbd_get_injected_scancode();
	62	lastctr = counter;
	63	while (inb(0x64) & 0x1)
	64	inb(0x60);
	65	} else
	66	b = inb(0x60);
	67	if ((curdev == 0) && (b == 0x01)) { /* Escape */
	68	outb(0xCF9, 0x4); /* Reboot */
	69	return;
	70	}
	71
	72	/* If there is more nus to come, generate another IRQ. */
	73	if (kbd_has_injected_scancode())
	74	cause_kbd_irq();
	75
	76	(unsigned char)0xAFFD0 /* EAX */ = b;
	77	break;
	78	}
	79
	80	(unsigned char)0xAFFD0 /* EAX */ = b;
	81	break;
	82	}
	83	case 0x30000:
	84	{
	85	unsigned char b;
	86
	87	b = (unsigned char)0xAFFD0 /* EAX */;
	88	dologf("WRITE: %08x (%02x)", cts, b);
	89	outb(cts & 0xFFFF, b);
	90	break;
	91	}
	92	default:
	93	dolog("Unhandled PCI cycle");
	94	}
	95
	96	outl(0x840, 0x0);
	97	outl(0x844, 0x1000);
	98	outl(0x848, 0x1000);
	99	}
	100
	101	void timer_handler(smi_event_t ev)
	102	{
	103	static unsigned int ticks = 0;
	104
	105	smi_disable_event(SMI_EVENT_FAST_TIMER);
	106	smi_enable_event(SMI_EVENT_FAST_TIMER);
	107
	108	if (kbd_has_injected_scancode() && (counter > (lastctr + 2)))
	109	{
	110	smi_disable_event(SMI_EVENT_DEVTRAP_KBC);
	111	dolog("Kicking timer");
	112	cause_kbd_irq();
	113	smi_enable_event(SMI_EVENT_DEVTRAP_KBC);
	114	}
	115
	116	outb(0x80, (ticks++) & 0xFF);
	117
	118	outlog();
	119	}
	120
	121	void kbc_handler(smi_event_t ev)
	122	{
	123	pci_dump();
	124	}
	125
	126	void gbl_rls_handler(smi_event_t ev)
	127	{
	128	unsigned long ecx;
	129
	130	ecx = (unsigned long)0xAFFD4;
	131
	132	packet_t * packet = check_packet(ecx);
	133	if (!packet)
	134	{
	135	dologf("WARN: bad packet at %08x", ecx);
	136	return;
	137	}
	138
	139	dologf("Got packet: type %08x", packet->type);
	140
	141	if (packet->type == 42) {
	142	dump_log((char *)packet->data);
	143	(unsigned long)0xAFFD4 = 42;
	144	} else if (packet->type == 0xAA) {
	145	kbd_inject_key('A');
	146	} else {
	147	(unsigned long)0xAFFD4 = 0x2BADD00D;
	148	}
	149	}
	150
	151	void smi_entry(void)
	152	{
	153	char statstr[512];
	154
	155	pcisave = inl(0xCF8);
	156	vgasave = inb(0x3D4);
	157	pci_unbother_all();
	158
	159	counter++;
	160	sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
	161	strblit(statstr, 0, 0);
	162
	163	eth_poll();
	164
	165	if (inl(0x840) & 0x1000)
	166	{
	167	pci_dump();
	168	outl(0x840, 0x1100);
	169	outl(0x840, 0x0100);
	170	}
	171
	172	smi_poll();
	173
	174	pci_bother_all();
	175	outl(0xCF8, pcisave);
	176	outb(0x3D4, vgasave);
	177	}
	178