[netwatch.git] / net / net.c

#include <pci.h>
#include <io.h>
#include <video_defines.h>
#include <smram.h>
#include <pci-bother.h>
#include <output.h>
#include <minilib.h>
#include "net.h"
#include "../aseg/keyboard.h"

static struct nic *_nic = 0x0;

extern struct pci_driver a3c90x_driver;

static char test[1024] = {0};

static char packet[4096] = {0};

typedef struct packet_t {
	char from[6];
	char to[6];
	unsigned short ethertype;
	unsigned short datalen;
	unsigned char command;
	char data[];
} packet_t;

static unsigned char vga_read(unsigned char idx)
{
	outb(CRTC_IDX_REG, idx);
	return inb(CRTC_DATA_REG);
}

static unsigned int vga_base()
{
	return (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
	     + (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1);
}

void handle_command(packet_t * p)
{
	uint16_t dl = htons(p->datalen);
	int i;

	outputf("NIC: Command: 0x%x, %d bytes", p->command, dl);

	if (p->command == 0x42)
	{
		for (i = 0; i < dl; i++)
			kbd_inject_key(p->data[i]);
	}
}

void eth_poll()
{
	int i;
//	static int c;
	static short pos = 0x0;
	unsigned short base = vga_base();
	unsigned char *p = (unsigned char *)0xB8000;
	smram_state_t old_state;
	
	if (!_nic)
		return;

	if (_nic->poll(_nic, 0)) {
		_nic->packet = packet;
		_nic->poll(_nic, 1);

		packet_t * p = (packet_t *) packet;

		outputf("NIC: Packet: %d 0x%x", _nic->packetlen, htons(p->ethertype));
		if (htons(p->ethertype) == 0x1338) {
			if (htons(p->datalen) + sizeof(packet_t) > _nic->packetlen) {
				outputf("NIC: Malformed packet");
			} else {
				handle_command(p);
			}
		}
	}
	smram_tseg_set_state(SMRAM_TSEG_OPEN);
	old_state = smram_save_state();
	
//	if ((c++) % 2)
//		return;

	if (((base + 80*25*2)%0x8000) < base)
	{
		if ((pos > ((base + 80*25*2)%0x8000)) && (pos < base))
			pos = base;
	} else if ((pos > base + 80*25*2) || (pos < base))
		pos = base;
	
	test[0] = pos >> 8;
	test[1] = pos & 0xFF;
	test[2] = base >> 8;
	test[3] = base & 0xFF;

	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
	
	for (i = 4; i < 1024; i++)
	{
		test[i] = p[pos++];
		pos %= 0x8000;
	}
	smram_restore_state(old_state);
	_nic->transmit("\x00\x03\x93\x87\x84\x8C", 0x1337, 1024, test);
}

int eth_register(struct nic *nic)
{
	if (_nic)
		return -1;
	_nic = nic;
	return 0;
}

void eth_init()
{
	/* Required for DMA to work. :( */
	smram_tseg_set_state(SMRAM_TSEG_OPEN);
	pci_probe_driver(a3c90x_driver);
}
Commit	Line	Data
3b3161a1	1	#include <pci.h>
6c744a5a JW	2	#include <io.h>
	3	#include <video_defines.h>
	4	#include <smram.h>
4d898e0b	5	#include <pci-bother.h>
3b3161a1	6	#include <output.h>
14e7cde4	7	#include <minilib.h>
4d898e0b	8	#include "net.h"
14e7cde4	9	#include "../aseg/keyboard.h"
3b3161a1	10
7a914840	11	static struct nic *_nic = 0x0;
3e6d6106	12
7a914840 JW	13	extern struct pci_driver a3c90x_driver;
7a914840 JW	14
99182958 JW	15	static char test[1024] = {0};
99182958 JW	16
50d89a31 JP	17	static char packet[4096] = {0};
	18
	19	typedef struct packet_t {
	20	char from[6];
	21	char to[6];
	22	unsigned short ethertype;
14e7cde4 JP	23	unsigned short datalen;
14e7cde4 JP	24	unsigned char command;
50d89a31 JP	25	char data[];
	26	} packet_t;
	27
6c744a5a JW	28	static unsigned char vga_read(unsigned char idx)
	29	{
	30	outb(CRTC_IDX_REG, idx);
	31	return inb(CRTC_DATA_REG);
	32	}
	33
	34	static unsigned int vga_base()
	35	{
	36	return (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
	37	+ (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1);
	38	}
	39
14e7cde4 JP	40	void handle_command(packet_t * p)
	41	{
	42	uint16_t dl = htons(p->datalen);
	43	int i;
	44
	45	outputf("NIC: Command: 0x%x, %d bytes", p->command, dl);
	46
	47	if (p->command == 0x42)
	48	{
	49	for (i = 0; i < dl; i++)
	50	kbd_inject_key(p->data[i]);
	51	}
	52	}
	53
7a914840	54	void eth_poll()
3b3161a1	55	{
99182958	56	int i;
6c744a5a JW	57	// static int c;
	58	static short pos = 0x0;
	59	unsigned short base = vga_base();
	60	unsigned char p = (unsigned char )0xB8000;
	61	smram_state_t old_state;
99182958 JW	62
	63	if (!_nic)
	64	return;
	65
50d89a31 JP	66	if (_nic->poll(_nic, 0)) {
	67	_nic->packet = packet;
	68	_nic->poll(_nic, 1);
	69
	70	packet_t * p = (packet_t *) packet;
	71
14e7cde4 JP	72	outputf("NIC: Packet: %d 0x%x", _nic->packetlen, htons(p->ethertype));
	73	if (htons(p->ethertype) == 0x1338) {
	74	if (htons(p->datalen) + sizeof(packet_t) > _nic->packetlen) {
	75	outputf("NIC: Malformed packet");
	76	} else {
	77	handle_command(p);
	78	}
50d89a31 JP	79	}
50d89a31 JP	80	}
6c744a5a JW	81	smram_tseg_set_state(SMRAM_TSEG_OPEN);
6c744a5a JW	82	old_state = smram_save_state();
99182958	83
6c744a5a JW	84	// if ((c++) % 2)
6c744a5a JW	85	// return;
d3411e0d JW	86
	87	if (((base + 80252)%0x8000) < base)
	88	{
	89	if ((pos > ((base + 80252)%0x8000)) && (pos < base))
	90	pos = base;
	91	} else if ((pos > base + 80252) \|\| (pos < base))
	92	pos = base;
6c744a5a JW	93
	94	test[0] = pos >> 8;
	95	test[1] = pos & 0xFF;
	96	test[2] = base >> 8;
	97	test[3] = base & 0xFF;
	98
	99	smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
99182958	100
6c744a5a	101	for (i = 4; i < 1024; i++)
99182958	102	{
6c744a5a JW	103	test[i] = p[pos++];
6c744a5a JW	104	pos %= 0x8000;
99182958	105	}
6c744a5a	106	smram_restore_state(old_state);
99182958	107	_nic->transmit("\x00\x03\x93\x87\x84\x8C", 0x1337, 1024, test);
3b3161a1 JW	108	}
3b3161a1 JW	109
7a914840	110	int eth_register(struct nic *nic)
3b3161a1	111	{
7a914840 JW	112	if (_nic)
	113	return -1;
	114	_nic = nic;
	115	return 0;
3b3161a1 JW	116	}
	117
	118	void eth_init()
	119	{
c25f3f39 JW	120	/* Required for DMA to work. :( */
	121	smram_tseg_set_state(SMRAM_TSEG_OPEN);
	122	pci_probe_driver(a3c90x_driver);
3b3161a1	123	}