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

... / ...

Commit	Line	Data
	1	#include <pci.h>
	2	#include <smram.h>
	3	#include <pci-bother.h>
	4	#include <output.h>
	5	#include <minilib.h>
	6	#include <lwip/init.h>
	7	#include "net.h"
	8
	9	#include "lwip/opt.h"
	10	#include "lwip/def.h"
	11	#include "lwip/mem.h"
	12	#include "lwip/pbuf.h"
	13	#include "lwip/sys.h"
	14	#include <lwip/stats.h>
	15	#include <lwip/snmp.h>
	16	#include <lwip/dhcp.h>
	17	#include <lwip/tcp.h>
	18	#include "netif/etharp.h"
	19	#include "netif/ppp_oe.h"
	20
	21	#include "rfb.h"
	22
	23	static struct nic *_nic = 0x0;
	24	static struct netif _netif;
	25
	26	extern struct pci_driver a3c90x_driver;
	27
	28	void eth_poll()
	29	{
	30	unsigned char pkt[1600];
	31	int len;
	32	struct pbuf p, q;
	33	struct eth_hdr *ethhdr;
	34	int pos = 0;
	35	static int ticks = 0;
	36
	37	if (!_nic)
	38	return;
	39
	40	smram_tseg_set_state(SMRAM_TSEG_OPEN);
	41
	42	if ((ticks % 1000) == 0) /* About a minute */
	43	dhcp_coarse_tmr();
	44	if ((ticks % 8) == 0) /* About 500msec*/
	45	dhcp_fine_tmr();
	46	if ((ticks % 4) == 0) /* About 250msec*/
	47	tcp_tmr();
	48	ticks++;
	49
	50	if (_nic->poll(_nic, 0))
	51	{
	52	_nic->packet = pkt;
	53	_nic->poll(_nic, 1);
	54
	55	len = _nic->packetlen;
	56
	57	outputf("NIC: Packet: %d bytes", len);
	58
	59	p = pbuf_alloc(PBUF_RAW, len, PBUF_POOL);
	60	if (p == NULL)
	61	{
	62	outputf("NIC: out of memory for packet?");
	63	LINK_STATS_INC(link.memerr);
	64	LINK_STATS_INC(link.drop);
	65	return;
	66	}
	67
	68	for(q = p; q != NULL; q = q->next)
	69	{
	70	memcpy(q->payload, pkt+pos, q->len);
	71	pos += q->len;
	72	}
	73
	74	LINK_STATS_INC(link.recv);
	75
	76	ethhdr = p->payload;
	77
	78	switch (htons(ethhdr->type)) {
	79	case ETHTYPE_IP:
	80	case ETHTYPE_ARP:
	81	if (_netif.input(p, &_netif) != ERR_OK)
	82	{
	83	LWIP_DEBUGF(NETIF_DEBUG, ("netdev_input: IP input error\n"));
	84	pbuf_free(p);
	85	}
	86	break;
	87
	88	default:
	89	outputf("Unhandled packet type %04x input", ethhdr->type);
	90	pbuf_free(p);
	91	break;
	92	}
	93	}
	94	}
	95
	96	static err_t _transmit(struct netif netif, struct pbuf p)
	97	{
	98	struct nic *nic = netif->state;
	99
	100	/* for(q = p; q != NULL; q = q->next)
	101	{
	102	memcpy(pkt + len, q->payload, q->len);
	103	len += q->len;
	104	}*/
	105
	106	outputf("NIC: Transmit packet");
	107
	108	nic->transmit(p);
	109
	110	LINK_STATS_INC(link.xmit);
	111
	112	return ERR_OK;
	113	}
	114
	115	static err_t _init(struct netif *netif)
	116	{
	117	struct nic *nic = netif->state;
	118
	119	LWIP_ASSERT("netif != NULL", (netif != NULL));
	120
	121	#if LWIP_NETIF_HOSTNAME
	122	netif->hostname = "netwatch";
	123	#endif
	124
	125	NETIF_INIT_SNMP(netif, snmp_ifType_ethernet_csmacd, 100000000);
	126
	127	netif->name[0] = 'e';
	128	netif->name[1] = 'n';
	129	netif->output = etharp_output;
	130	netif->linkoutput = _transmit;
	131
	132	memcpy(netif->hwaddr, nic->hwaddr, 6);
	133	netif->mtu = 1500;
	134	netif->hwaddr_len = ETHARP_HWADDR_LEN;
	135	netif->flags = NETIF_FLAG_BROADCAST \| NETIF_FLAG_ETHARP \| NETIF_FLAG_LINK_UP;
	136
	137	return ERR_OK;
	138	}
	139
	140	int eth_register(struct nic *nic)
	141	{
	142	static struct ip_addr ipa = { 0 } , netmask = { 0 } , gw = { 0 };
	143
	144	if (_nic)
	145	return -1;
	146	netif_add(&_netif, &ipa, &netmask, &gw, (void*)nic, _init, ethernet_input);
	147	netif_set_default(&_netif);
	148	netif_set_up(&_netif);
	149	dhcp_start(&_netif);
	150	_nic = nic;
	151	return 0;
	152	}
	153
	154	void eth_init()
	155	{
	156	extern void httpd_init();
	157
	158	/* Required for DMA to work. :( */
	159	smram_tseg_set_state(SMRAM_TSEG_OPEN);
	160	lwip_init();
	161	httpd_init();
	162
	163	rfb_init();
	164
	165	}