/[gxemul]/trunk/src/net/net.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Contents of /trunk/src/net/net.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 34 - (show annotations)
Mon Oct 8 16:21:17 2007 UTC (16 years, 6 months ago) by dpavlin
File MIME type: text/plain
File size: 22004 byte(s)
++ trunk/HISTORY	(local)
$Id: HISTORY,v 1.1480 2007/02/19 01:34:42 debug Exp $
20061029	Changing usleep(1) calls in the debugger to usleep(10000)
20061107	Adding a new disk image option (-d o...) which sets the ISO9660
		filesystem base offset; also making some other hacks to allow
		NetBSD/dreamcast and homebrew demos/games to boot directly
		from a filesystem image.
		Moving Dreamcast-specific stuff in the documentation to its
		own page (dreamcast.html).
		Adding a border to the Dreamcast PVR framebuffer.
20061108	Adding a -T command line option (again?), for halting the
		emulator on unimplemented memory accesses.
20061109	Continuing on various SH4 and Dreamcast related things.
		The emulator should now halt on more unimplemented device
		accesses, instead of just printing a warning, forcing me to
		actually implement missing stuff :)
20061111	Continuing on SH4 and Dreamcast stuff.
		Adding a bogus Landisk (SH4) machine mode.
20061112	Implementing some parts of the Dreamcast GDROM device. With
		some ugly hacks, NetBSD can (barely) mount an ISO image.
20061113	NetBSD/dreamcast now starts booting from the Live CD image,
		but crashes randomly quite early on in the boot process.
20061122	Beginning on a skeleton interrupt.h and interrupt.c for the
		new interrupt subsystem.
20061124	Continuing on the new interrupt system; taking the first steps
		to attempt to connect CPUs (SuperH and MIPS) and devices
		(dev_cons and SH4 timer interrupts) to it. Many things will
		probably break from now on.
20061125	Converting dev_ns16550, dev_8253 to the new interrupt system.
		Attempting to begin to convert the ISA bus.
20061130	Incorporating a patch from Brian Foley for the configure
		script, which checks for X11 libs in /usr/X11R6/lib64 (which
		is used on some Linux systems).
20061227	Adding a note in the man page about booting from Dreamcast
		CDROM images (i.e. that no external kernel is needed).
20061229	Continuing on the interrupt system rewrite: beginning to
		convert more devices, adding abort() calls for legacy interrupt
		system calls so that everything now _has_ to be rewritten!
		Almost all machine modes are now completely broken.
20061230	More progress on removing old interrupt code, mostly related
		to the ISA bus + devices, the LCA bus (on AlphaBook1), and
		the Footbridge bus (for CATS). And some minor PCI stuff.
		Connecting the ARM cpu to the new interrupt system.
		The CATS, NetWinder, and QEMU_MIPS machine modes now work with
		the new interrupt system :)
20061231	Connecting PowerPC CPUs to the new interrupt system.
		Making PReP machines (IBM 6050) work again.
		Beginning to convert the GT PCI controller (for e.g. Malta
		and Cobalt emulation). Some things work, but not everything.
		Updating Copyright notices for 2007.
20070101	Converting dev_kn02 from legacy style to devinit; the 3max
		machine mode now works with the new interrupt system :-]
20070105	Beginning to convert the SGI O2 machine to the new interrupt
		system; finally converting O2 (IP32) devices to devinit, etc.
20070106	Continuing on the interrupt system redesign/rewrite; KN01
		(PMAX), KN230, and Dreamcast ASIC interrupts should work again,
		moving out stuff from machine.h and devices.h into the
		corresponding devices, beginning the rewrite of i80321
		interrupts, etc.
20070107	Beginning on the rewrite of Eagle interrupt stuff (PReP, etc).
20070117	Beginning the rewrite of Algor (V3) interrupts (finally
		changing dev_v3 into devinit style).
20070118	Removing the "bus" registry concept from machine.h, because
		it was practically meaningless.
		Continuing on the rewrite of Algor V3 ISA interrupts.
20070121	More work on Algor interrupts; they are now working again,
		well enough to run NetBSD/algor. :-)
20070122	Converting VR41xx (HPCmips) interrupts. NetBSD/hpcmips
		can be installed using the new interrupt system :-)
20070123	Making the testmips mode work with the new interrupt system.
20070127	Beginning to convert DEC5800 devices to devinit, and to the
		new interrupt system.
		Converting Playstation 2 devices to devinit, and converting
		the interrupt system. Also fixing a severe bug: the interrupt
		mask register on Playstation 2 is bitwise _toggled_ on writes.
20070128	Removing the dummy NetGear machine mode and the 8250 device
		(which was only used by the NetGear machine).
		Beginning to convert the MacPPC GC (Grand Central) interrupt
		controller to the new interrupt system.
		Converting Jazz interrupts (PICA61 etc.) to the new interrupt
		system. NetBSD/arc can be installed again :-)
		Fixing the JAZZ timer (hardcoding it at 100 Hz, works with
		NetBSD and it is better than a completely dummy timer as it
		was before).
		Converting dev_mp to the new interrupt system, although I
		haven't had time to actually test it yet.
		Completely removing src/machines/interrupts.c, cpu_interrupt
		and cpu_interrupt_ack in src/cpu.c, and
		src/include/machine_interrupts.h! Adding fatal error messages
		+ abort() in the few places that are left to fix.
		Converting dev_z8530 to the new interrupt system.
		FINALLY removing the md_int struct completely from the
		machine struct.
		SH4 fixes (adding a PADDR invalidation in the ITLB replacement
		code in memory_sh.c); the NetBSD/dreamcast LiveCD now runs
		all the way to the login prompt, and can be interacted with :-)
		Converting the CPC700 controller (PCI and interrupt controller
		for PM/PPC) to the new interrupt system.
20070129	Fixing MACE ISA interrupts (SGI IP32 emulation). Both NetBSD/
		sgimips' and OpenBSD/sgi's ramdisk kernels can now be
		interacted with again.
20070130	Moving out the MIPS multi_lw and _sw instruction combinations
		so that they are auto-generated at compile time instead.
20070131	Adding detection of amd64/x86_64 hosts in the configure script,
		for doing initial experiments (again :-) with native code
		generation.
		Adding a -k command line option to set the size of the dyntrans
		cache, and a -B command line option to disable native code
		generation, even if GXemul was compiled with support for
		native code generation for the specific host CPU architecture.
20070201	Experimenting with a skeleton for native code generation.
		Changing the default behaviour, so that native code generation
		is now disabled by default, and has to be enabled by using
		-b on the command line.
20070202	Continuing the native code generation experiments.
		Making PCI interrupts work for Footbridge again.
20070203	More native code generation experiments.
		Removing most of the native code generation experimental code,
		it does not make sense to include any quick hacks like this.
		Minor cleanup/removal of some more legacy MIPS interrupt code.
20070204	Making i80321 interrupts work again (for NetBSD/evbarm etc.),
		and fixing the timer at 100 Hz.
20070206	Experimenting with removing the wdc interrupt slowness hack.
20070207	Lowering the number of dyntrans TLB entries for MIPS from
		192 to 128, resulting in a minor speed improvement.
		Minor optimization to the code invalidation routine in
		cpu_dyntrans.c.
20070208	Increasing (experimentally) the nr of dyntrans instructions per
		loop from 60 to 120.
20070210	Commenting out (experimentally) the dyntrans_device_danger
		detection in memory_rw.c.
		Changing the testmips and baremips machines to use a revision 2
		MIPS64 CPU by default, instead of revision 1.
		Removing the dummy i960, IA64, x86, AVR32, and HP PA-RISC
		files, the PC bios emulation, and the Olivetti M700 (ARC) and
		db64360 emulation modes.
20070211	Adding an "mp" demo to the demos directory, which tests the
		SMP functionality of the testmips machine.
		Fixing PReP interrupts some more. NetBSD/prep now boots again.
20070216	Adding a "nop workaround" for booting Mach/PMAX to the
		documentation; thanks to Artur Bujdoso for the values.
		Converting more of the MacPPC interrupt stuff to the new
		system.
		Beginning to convert BeBox interrupts to the new system.
		PPC603e should NOT have the PPC_NO_DEC flag! Removing it.
		Correcting BeBox clock speed (it was set to 100 in the NetBSD
		bootinfo block, but should be 33000000/4), allowing NetBSD
		to start without using the (incorrect) PPC_NO_DEC hack.
20070217	Implementing (slow) AltiVec vector loads and stores, allowing
		NetBSD/macppc to finally boot using the GENERIC kernel :-)
		Updating the documentation with install instructions for
		NetBSD/macppc.
20070218-19	Regression testing for the release.

==============  RELEASE 0.4.4  ==============


1 /*
2 * Copyright (C) 2004-2007 Anders Gavare. All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * 1. Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
12 * 3. The name of the author may not be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 *
27 *
28 * $Id: net.c,v 1.7 2006/12/30 13:31:02 debug Exp $
29 *
30 * Emulated network.
31 *
32 * (Read the README file in this directory for more details.)
33 *
34 *
35 * NOTE: The 'extra' argument used in many functions in this file is a pointer
36 * to something unique for each NIC (i.e. the NIC itself :-), so that if
37 * multiple NICs are emulated concurrently, they will not get packets that
38 * are meant for some other controller.
39 */
40
41 #include <stdio.h>
42 #include <stdlib.h>
43 #include <string.h>
44 #include <unistd.h>
45 #include <errno.h>
46 #include <sys/types.h>
47 #include <sys/socket.h>
48 #include <netinet/in.h>
49 #include <arpa/inet.h>
50 #include <netdb.h>
51 #include <fcntl.h>
52 #include <signal.h>
53
54 #include "machine.h"
55 #include "misc.h"
56 #include "net.h"
57
58
59 /* #define debug fatal */
60
61
62 /*
63 * net_allocate_ethernet_packet_link():
64 *
65 * This routine allocates an ethernet_packet_link struct, and adds it at
66 * the end of the packet chain. A data buffer is allocated, and the data,
67 * extra, and len fields of the link are set.
68 *
69 * Note: The data buffer is not zeroed.
70 *
71 * Return value is a pointer to the link on success. It doesn't return on
72 * failure.
73 */
74 struct ethernet_packet_link *net_allocate_ethernet_packet_link(
75 struct net *net, void *extra, size_t len)
76 {
77 struct ethernet_packet_link *lp;
78
79 lp = malloc(sizeof(struct ethernet_packet_link));
80 if (lp == NULL)
81 goto fail;
82
83 lp->len = len;
84 lp->extra = extra;
85 lp->data = malloc(len);
86 if (lp->data == NULL)
87 goto fail;
88
89 lp->next = NULL;
90
91 /* Add last in the link chain: */
92 lp->prev = net->last_ethernet_packet;
93 if (lp->prev != NULL)
94 lp->prev->next = lp;
95 else
96 net->first_ethernet_packet = lp;
97 net->last_ethernet_packet = lp;
98
99 return lp;
100
101 fail:
102 fprintf(stderr, "net_allocate_ethernet_packet_link(): out of memory\n");
103 exit(1);
104 }
105
106
107 /*
108 * net_arp():
109 *
110 * Handle an ARP (or RARP) packet, coming from the emulated NIC.
111 *
112 * An ARP packet might look like this:
113 *
114 * ARP header:
115 * ARP hardware addr family: 0001
116 * ARP protocol addr family: 0800
117 * ARP addr lengths: 06 04
118 * ARP request: 0001
119 * ARP from: 112233445566 01020304
120 * ARP to: 000000000000 01020301
121 *
122 * An ARP request with a 'to' IP value of the gateway should cause an
123 * ARP response packet to be created.
124 *
125 * An ARP request with the same from and to IP addresses should be ignored.
126 * (This would be a host testing to see if there is an IP collision.)
127 */
128 static void net_arp(struct net *net, void *extra,
129 unsigned char *packet, int len, int reverse)
130 {
131 int q;
132 int i;
133
134 /* TODO: This debug dump assumes ethernet->IPv4 translation: */
135 if (reverse)
136 debug("[ net: RARP: ");
137 else
138 debug("[ net: ARP: ");
139 for (i=0; i<2; i++)
140 debug("%02x", packet[i]);
141 debug(" ");
142 for (i=2; i<4; i++)
143 debug("%02x", packet[i]);
144 debug(" ");
145 debug("%02x", packet[4]);
146 debug(" ");
147 debug("%02x", packet[5]);
148 debug(" req=");
149 debug("%02x", packet[6]); /* Request type */
150 debug("%02x", packet[7]);
151 debug(" from=");
152 for (i=8; i<18; i++)
153 debug("%02x", packet[i]);
154 debug(" to=");
155 for (i=18; i<28; i++)
156 debug("%02x", packet[i]);
157 debug(" ]\n");
158
159 if (packet[0] == 0x00 && packet[1] == 0x01 &&
160 packet[2] == 0x08 && packet[3] == 0x00 &&
161 packet[4] == 0x06 && packet[5] == 0x04) {
162 int r = (packet[6] << 8) + packet[7];
163 struct ethernet_packet_link *lp;
164
165 switch (r) {
166 case 1: /* Request */
167 /* Only create a reply if this was meant for the
168 gateway: */
169 if (memcmp(packet+24, net->gateway_ipv4_addr, 4) != 0)
170 break;
171
172 lp = net_allocate_ethernet_packet_link(
173 net, extra, 60 + 14);
174
175 /* Copy the old packet first: */
176 memset(lp->data, 0, 60 + 14);
177 memcpy(lp->data + 14, packet, len);
178
179 /* Add ethernet ARP header: */
180 memcpy(lp->data + 0, lp->data + 8 + 14, 6);
181 memcpy(lp->data + 6, net->gateway_ethernet_addr, 6);
182 lp->data[12] = 0x08; lp->data[13] = 0x06;
183
184 /* Address of the emulated machine: */
185 memcpy(lp->data + 18 + 14, lp->data + 8 + 14, 10);
186
187 /* Address of the gateway: */
188 memcpy(lp->data + 8 + 14, net->gateway_ethernet_addr,
189 6);
190 memcpy(lp->data + 14 + 14, net->gateway_ipv4_addr, 4);
191
192 /* This is a Reply: */
193 lp->data[6 + 14] = 0x00; lp->data[7 + 14] = 0x02;
194
195 break;
196 case 3: /* Reverse Request */
197 lp = net_allocate_ethernet_packet_link(
198 net, extra, 60 + 14);
199
200 /* Copy the old packet first: */
201 memset(lp->data, 0, 60 + 14);
202 memcpy(lp->data + 14, packet, len);
203
204 /* Add ethernet RARP header: */
205 memcpy(lp->data + 0, packet + 8, 6);
206 memcpy(lp->data + 6, net->gateway_ethernet_addr, 6);
207 lp->data[12] = 0x80; lp->data[13] = 0x35;
208
209 /* This is a RARP reply: */
210 lp->data[6 + 14] = 0x00; lp->data[7 + 14] = 0x04;
211
212 /* Address of the gateway: */
213 memcpy(lp->data + 8 + 14, net->gateway_ethernet_addr,
214 6);
215 memcpy(lp->data + 14 + 14, net->gateway_ipv4_addr, 4);
216
217 /* MAC address of emulated machine: */
218 memcpy(lp->data + 18 + 14, packet + 8, 6);
219
220 /*
221 * IP address of the emulated machine: Automagically
222 * generated from the MAC address. :-)
223 *
224 * packet+8 points to the client's mac address,
225 * for example 10:20:30:00:00:z0, where z is 0..15.
226 * 10:20:30:00:00:10 results in 10.0.0.1.
227 */
228 /* q = (packet[8 + 3]) >> 4; */
229 /* q = q*15 + ((packet[8 + 4]) >> 4); */
230 q = (packet[8 + 5]) >> 4;
231 lp->data[24 + 14] = 10;
232 lp->data[25 + 14] = 0;
233 lp->data[26 + 14] = 0;
234 lp->data[27 + 14] = q;
235 break;
236 case 2: /* Reply */
237 case 4: /* Reverse Reply */
238 default:
239 fatal("[ net: ARP: UNIMPLEMENTED request type "
240 "0x%04x ]\n", r);
241 }
242 } else {
243 fatal("[ net: ARP: UNIMPLEMENTED arp packet type: ");
244 for (i=0; i<len; i++)
245 fatal("%02x", packet[i]);
246 fatal(" ]\n");
247 }
248 }
249
250
251 /*
252 * net_ethernet_rx_avail():
253 *
254 * Return 1 if there is a packet available for this 'extra' pointer, otherwise
255 * return 0.
256 *
257 * Appart from actually checking for incoming packets from the outside world,
258 * this function basically works like net_ethernet_rx() but it only receives
259 * a return value telling us whether there is a packet or not, we don't
260 * actually get the packet.
261 */
262 int net_ethernet_rx_avail(struct net *net, void *extra)
263 {
264 if (net == NULL)
265 return 0;
266
267 /*
268 * If the network is distributed across multiple emulator processes,
269 * then receive incoming packets from those processes.
270 */
271 if (net->local_port != 0) {
272 struct sockaddr_in si;
273 socklen_t si_len = sizeof(si);
274 int res, i, nreceived = 0;
275 unsigned char buf[60000];
276
277 do {
278 res = recvfrom(net->local_port_socket, buf,
279 sizeof(buf), 0, (struct sockaddr *)&si, &si_len);
280
281 if (res != -1) {
282 nreceived ++;
283
284 /* fatal("[ incoming DISTRIBUTED packet, %i "
285 "bytes from %s:%d\n", res,
286 inet_ntoa(si.sin_addr),
287 ntohs(si.sin_port)); */
288
289 /* Add the packet to all "our" NICs on this
290 network: */
291 for (i=0; i<net->n_nics; i++) {
292 struct ethernet_packet_link *lp;
293 lp = net_allocate_ethernet_packet_link(
294 net, net->nic_extra[i], res);
295 memcpy(lp->data, buf, res);
296 }
297 }
298 } while (res != -1 && nreceived < 100);
299 }
300
301 /* IP protocol specific: */
302 net_udp_rx_avail(net, extra);
303 net_tcp_rx_avail(net, extra);
304
305 return net_ethernet_rx(net, extra, NULL, NULL);
306 }
307
308
309 /*
310 * net_ethernet_rx():
311 *
312 * Receive an ethernet packet. (This means handing over an already prepared
313 * packet from this module to a specific ethernet controller device.)
314 *
315 * Return value is 1 if there was a packet available. *packetp and *lenp
316 * will be set to the packet's data pointer and length, respectively, and
317 * the packet will be removed from the linked list). If there was no packet
318 * available, 0 is returned.
319 *
320 * If packetp is NULL, then the search is aborted as soon as a packet with
321 * the correct 'extra' field is found, and a 1 is returned, but as packetp
322 * is NULL we can't return the actual packet. (This is the internal form
323 * if net_ethernet_rx_avail().)
324 */
325 int net_ethernet_rx(struct net *net, void *extra,
326 unsigned char **packetp, int *lenp)
327 {
328 struct ethernet_packet_link *lp, *prev;
329
330 if (net == NULL)
331 return 0;
332
333 /* Find the first packet which has the right 'extra' field. */
334
335 lp = net->first_ethernet_packet;
336 prev = NULL;
337 while (lp != NULL) {
338 if (lp->extra == extra) {
339 /* We found a packet for this controller! */
340 if (packetp == NULL || lenp == NULL)
341 return 1;
342
343 /* Let's return it: */
344 (*packetp) = lp->data;
345 (*lenp) = lp->len;
346
347 /* Remove this link from the linked list: */
348 if (prev == NULL)
349 net->first_ethernet_packet = lp->next;
350 else
351 prev->next = lp->next;
352
353 if (lp->next == NULL)
354 net->last_ethernet_packet = prev;
355 else
356 lp->next->prev = prev;
357
358 free(lp);
359
360 /* ... and return successfully: */
361 return 1;
362 }
363
364 prev = lp;
365 lp = lp->next;
366 }
367
368 /* No packet found. :-( */
369 return 0;
370 }
371
372
373 /*
374 * net_ethernet_tx():
375 *
376 * Transmit an ethernet packet, as seen from the emulated ethernet controller.
377 * If the packet can be handled here, it will not necessarily be transmitted
378 * to the outside world.
379 */
380 void net_ethernet_tx(struct net *net, void *extra,
381 unsigned char *packet, int len)
382 {
383 int i, eth_type, for_the_gateway;
384
385 if (net == NULL)
386 return;
387
388 for_the_gateway = !memcmp(packet, net->gateway_ethernet_addr, 6);
389
390 /* Drop too small packets: */
391 if (len < 20) {
392 fatal("[ net_ethernet_tx: Warning: dropping tiny packet "
393 "(%i bytes) ]\n", len);
394 return;
395 }
396
397 /*
398 * Copy this packet to all other NICs on this network (except if
399 * it is aimed specifically at the gateway's ethernet address):
400 */
401 if (!for_the_gateway && extra != NULL && net->n_nics > 0) {
402 for (i=0; i<net->n_nics; i++)
403 if (extra != net->nic_extra[i]) {
404 struct ethernet_packet_link *lp;
405 lp = net_allocate_ethernet_packet_link(net,
406 net->nic_extra[i], len);
407
408 /* Copy the entire packet: */
409 memcpy(lp->data, packet, len);
410 }
411 }
412
413 /*
414 * If this network is distributed across multiple emulator processes,
415 * then transmit the packet to those other processes.
416 */
417 if (!for_the_gateway && net->remote_nets != NULL) {
418 struct remote_net *rnp = net->remote_nets;
419 while (rnp != NULL) {
420 send_udp(&rnp->ipv4_addr, rnp->portnr, packet, len);
421 rnp = rnp->next;
422 }
423 }
424
425
426 /*
427 * The code below simulates the behaviour of a "NAT"-style gateway.
428 *
429 * Packets that are not destined for the gateway are dropped first:
430 * (DHCP packets are let through, though.)
431 */
432
433 if (!for_the_gateway && packet[0] != 0xff && packet[0] != 0x00)
434 return;
435
436 #if 0
437 fatal("[ net: ethernet: ");
438 for (i=0; i<6; i++) fatal("%02x", packet[i]); fatal(" ");
439 for (i=6; i<12; i++) fatal("%02x", packet[i]); fatal(" ");
440 for (i=12; i<14; i++) fatal("%02x", packet[i]); fatal(" ");
441 for (i=14; i<len; i++) fatal("%02x", packet[i]); fatal(" ]\n");
442 #endif
443
444 eth_type = (packet[12] << 8) + packet[13];
445
446 /* IP: */
447 if (eth_type == ETHERTYPE_IP) {
448 /* Routed via the gateway? */
449 if (for_the_gateway) {
450 net_ip(net, extra, packet, len);
451 return;
452 }
453
454 /* Broadcast? (DHCP does this.) */
455 if (packet[0] == 0xff && packet[1] == 0xff &&
456 packet[2] == 0xff && packet[3] == 0xff &&
457 packet[4] == 0xff && packet[5] == 0xff) {
458 net_ip_broadcast(net, extra, packet, len);
459 return;
460 }
461
462 if (net->n_nics < 2) {
463 fatal("[ net_ethernet_tx: IP packet not for gateway, "
464 "and not broadcast: ");
465 for (i=0; i<14; i++)
466 fatal("%02x", packet[i]);
467 fatal(" ]\n");
468 }
469 return;
470 }
471
472 /* ARP: */
473 if (eth_type == ETHERTYPE_ARP) {
474 if (len != 42 && len != 60)
475 fatal("[ net_ethernet_tx: WARNING! unusual "
476 "ARP len (%i) ]\n", len);
477 net_arp(net, extra, packet + 14, len - 14, 0);
478 return;
479 }
480
481 /* RARP: */
482 if (eth_type == ETHERTYPE_REVARP) {
483 net_arp(net, extra, packet + 14, len - 14, 1);
484 return;
485 }
486
487 /* Sprite: */
488 if (eth_type == ETHERTYPE_SPRITE) {
489 /* TODO. */
490 fatal("[ net: TX: UNIMPLEMENTED Sprite packet ]\n");
491 return;
492 }
493
494 /* IPv6: */
495 if (eth_type == ETHERTYPE_IPV6) {
496 /* TODO. */
497 fatal("[ net_ethernet_tx: IPv6 is not implemented yet! ]\n");
498 return;
499 }
500
501 fatal("[ net_ethernet_tx: ethernet packet type 0x%04x not yet "
502 "implemented ]\n", eth_type);
503 }
504
505
506 /*
507 * parse_resolvconf():
508 *
509 * This function parses "/etc/resolv.conf" to figure out the nameserver
510 * and domain used by the host.
511 */
512 static void parse_resolvconf(struct net *net)
513 {
514 FILE *f;
515 char buf[8000];
516 size_t len;
517 int res;
518 unsigned int i, start;
519
520 /*
521 * This is a very ugly hack, which tries to figure out which
522 * nameserver the host uses by looking for the string 'nameserver'
523 * in /etc/resolv.conf.
524 *
525 * This can later on be used for DHCP autoconfiguration. (TODO)
526 *
527 * TODO: This is hardcoded to use /etc/resolv.conf. Not all
528 * operating systems use that filename.
529 *
530 * TODO: This is hardcoded for AF_INET (that is, IPv4).
531 *
532 * TODO: This assumes that the first nameserver listed is the
533 * one to use.
534 */
535 f = fopen("/etc/resolv.conf", "r");
536 if (f == NULL)
537 return;
538
539 /* TODO: get rid of the hardcoded values */
540 memset(buf, 0, sizeof(buf));
541 len = fread(buf, 1, sizeof(buf) - 100, f);
542 fclose(f);
543 buf[sizeof(buf) - 1] = '\0';
544
545 for (i=0; i<len; i++)
546 if (strncmp(buf+i, "nameserver", 10) == 0) {
547 char *p;
548
549 /*
550 * "nameserver" (1 or more whitespace)
551 * "x.y.z.w" (non-digit)
552 */
553
554 /* debug("found nameserver at offset %i\n", i); */
555 i += 10;
556 while (i<len && (buf[i]==' ' || buf[i]=='\t'))
557 i++;
558 if (i >= len)
559 break;
560 start = i;
561
562 p = buf+start;
563 while ((*p >= '0' && *p <= '9') || *p == '.')
564 p++;
565 *p = '\0';
566
567 #ifdef HAVE_INET_PTON
568 res = inet_pton(AF_INET, buf + start,
569 &net->nameserver_ipv4);
570 #else
571 res = inet_aton(buf + start, &net->nameserver_ipv4);
572 #endif
573 if (res < 1)
574 break;
575
576 net->nameserver_known = 1;
577 break;
578 }
579
580 for (i=0; i<len; i++)
581 if (strncmp(buf+i, "domain", 6) == 0) {
582 /* "domain" (1 or more whitespace) domain_name */
583 i += 6;
584 while (i<len && (buf[i]==' ' || buf[i]=='\t'))
585 i++;
586 if (i >= len)
587 break;
588
589 start = i;
590 while (i<len && buf[i]!='\n' && buf[i]!='\r')
591 i++;
592 if (i < len)
593 buf[i] = '\0';
594 /* fatal("DOMAIN='%s'\n", buf + start); */
595 net->domain_name = strdup(buf + start);
596 break;
597 }
598 }
599
600
601 /*
602 * net_add_nic():
603 *
604 * Add a NIC to a network. (All NICs on a network will see each other's
605 * packets.)
606 */
607 void net_add_nic(struct net *net, void *extra, unsigned char *macaddr)
608 {
609 if (net == NULL)
610 return;
611
612 if (extra == NULL) {
613 fprintf(stderr, "net_add_nic(): extra = NULL\n");
614 exit(1);
615 }
616
617 net->n_nics ++;
618 net->nic_extra = realloc(net->nic_extra, sizeof(void *)
619 * net->n_nics);
620 if (net->nic_extra == NULL) {
621 fprintf(stderr, "net_add_nic(): out of memory\n");
622 exit(1);
623 }
624
625 net->nic_extra[net->n_nics - 1] = extra;
626 }
627
628
629 /*
630 * net_gateway_init():
631 *
632 * This function creates a "gateway" machine (for example at IPv4 address
633 * 10.0.0.254, if the net is 10.0.0.0/8), which acts as a gateway/router/
634 * nameserver etc.
635 */
636 static void net_gateway_init(struct net *net)
637 {
638 unsigned char *p = (void *) &net->netmask_ipv4;
639 uint32_t x;
640 int xl;
641
642 x = (p[0] << 24) + (p[1] << 16) + (p[2] << 8) + p[3];
643 xl = 32 - net->netmask_ipv4_len;
644 if (xl > 8)
645 xl = 8;
646 x |= ((1 << xl) - 1) & ~1;
647
648 net->gateway_ipv4_addr[0] = x >> 24;
649 net->gateway_ipv4_addr[1] = x >> 16;
650 net->gateway_ipv4_addr[2] = x >> 8;
651 net->gateway_ipv4_addr[3] = x;
652
653 net->gateway_ethernet_addr[0] = 0x60;
654 net->gateway_ethernet_addr[1] = 0x50;
655 net->gateway_ethernet_addr[2] = 0x40;
656 net->gateway_ethernet_addr[3] = 0x30;
657 net->gateway_ethernet_addr[4] = 0x20;
658 net->gateway_ethernet_addr[5] = 0x10;
659 }
660
661
662 /*
663 * net_dumpinfo():
664 *
665 * Called from the debugger's "machine" command, to print some info about
666 * a network.
667 */
668 void net_dumpinfo(struct net *net)
669 {
670 int iadd = DEBUG_INDENTATION;
671 struct remote_net *rnp;
672
673 debug("net: simulating ");
674
675 net_debugaddr(&net->netmask_ipv4, NET_ADDR_IPV4);
676 debug("/%i", net->netmask_ipv4_len);
677
678 debug(" (max outgoing: TCP=%i, UDP=%i)\n",
679 MAX_TCP_CONNECTIONS, MAX_UDP_CONNECTIONS);
680
681 debug_indentation(iadd);
682
683 debug("simulated gateway: ");
684 net_debugaddr(&net->gateway_ipv4_addr, NET_ADDR_IPV4);
685 debug(" (");
686 net_debugaddr(&net->gateway_ethernet_addr, NET_ADDR_ETHERNET);
687 debug(")\n");
688
689 debug_indentation(iadd);
690 if (!net->nameserver_known) {
691 debug("(could not determine nameserver)");
692 } else {
693 debug("using nameserver ");
694 net_debugaddr(&net->nameserver_ipv4, NET_ADDR_IPV4);
695 }
696 if (net->domain_name != NULL && net->domain_name[0])
697 debug(", domain \"%s\"", net->domain_name);
698 debug("\n");
699 debug_indentation(-iadd);
700
701 rnp = net->remote_nets;
702 if (net->local_port != 0)
703 debug("distributed network: local port = %i\n",
704 net->local_port);
705 debug_indentation(iadd);
706 while (rnp != NULL) {
707 debug("remote \"%s\": ", rnp->name);
708 net_debugaddr(&rnp->ipv4_addr, NET_ADDR_IPV4);
709 debug(" port %i\n", rnp->portnr);
710 rnp = rnp->next;
711 }
712 debug_indentation(-iadd);
713
714 debug_indentation(-iadd);
715 }
716
717
718 /*
719 * net_init():
720 *
721 * This function creates a network, and returns a pointer to it.
722 *
723 * ipv4addr should be something like "10.0.0.0", netipv4len = 8.
724 *
725 * If n_remote is more than zero, remote should be a pointer to an array
726 * of strings of the following format: "host:portnr".
727 *
728 * Network settings are registered if settings_prefix is non-NULL.
729 * (The one calling net_init() is also responsible for calling net_deinit().)
730 *
731 * On failure, exit() is called.
732 */
733 struct net *net_init(struct emul *emul, int init_flags,
734 const char *ipv4addr, int netipv4len,
735 char **remote, int n_remote, int local_port,
736 const char *settings_prefix)
737 {
738 struct net *net;
739 int res;
740
741 net = malloc(sizeof(struct net));
742 if (net == NULL) {
743 fprintf(stderr, "net_init(): out of memory\n");
744 exit(1);
745 }
746
747 memset(net, 0, sizeof(struct net));
748
749 /* Set the back pointer: */
750 net->emul = emul;
751
752 /* Sane defaults: */
753 net->timestamp = 0;
754 net->first_ethernet_packet = net->last_ethernet_packet = NULL;
755
756 #ifdef HAVE_INET_PTON
757 res = inet_pton(AF_INET, ipv4addr, &net->netmask_ipv4);
758 #else
759 res = inet_aton(ipv4addr, &net->netmask_ipv4);
760 #endif
761 if (res < 1) {
762 fprintf(stderr, "net_init(): could not parse IPv4 address"
763 " '%s'\n", ipv4addr);
764 exit(1);
765 }
766
767 if (netipv4len < 1 || netipv4len > 30) {
768 fprintf(stderr, "net_init(): extremely weird ipv4 "
769 "network length (%i)\n", netipv4len);
770 exit(1);
771 }
772 net->netmask_ipv4_len = netipv4len;
773
774 net->nameserver_known = 0;
775 net->domain_name = "";
776 parse_resolvconf(net);
777
778 /* Distributed network? Then add remote hosts: */
779 if (local_port != 0) {
780 struct sockaddr_in si_self;
781
782 net->local_port = local_port;
783 net->local_port_socket = socket(AF_INET, SOCK_DGRAM, 0);
784 if (net->local_port_socket < 0) {
785 perror("socket");
786 exit(1);
787 }
788
789 memset((char *)&si_self, sizeof(si_self), 0);
790 si_self.sin_family = AF_INET;
791 si_self.sin_port = htons(local_port);
792 si_self.sin_addr.s_addr = htonl(INADDR_ANY);
793 if (bind(net->local_port_socket, (struct sockaddr *)&si_self,
794 sizeof(si_self)) < 0) {
795 perror("bind");
796 exit(1);
797 }
798
799 /* Set the socket to non-blocking: */
800 res = fcntl(net->local_port_socket, F_GETFL);
801 fcntl(net->local_port_socket, F_SETFL, res | O_NONBLOCK);
802 }
803 if (n_remote != 0) {
804 struct remote_net *rnp;
805 while ((n_remote--) != 0) {
806 struct hostent *hp;
807
808 /* debug("adding '%s'\n", remote[n_remote]); */
809 rnp = malloc(sizeof(struct remote_net));
810 memset(rnp, 0, sizeof(struct remote_net));
811
812 rnp->next = net->remote_nets;
813 net->remote_nets = rnp;
814
815 rnp->name = strdup(remote[n_remote]);
816 if (strchr(rnp->name, ':') != NULL)
817 strchr(rnp->name, ':')[0] = '\0';
818
819 hp = gethostbyname(rnp->name);
820 if (hp == NULL) {
821 fprintf(stderr, "could not resolve '%s'\n",
822 rnp->name);
823 exit(1);
824 }
825 memcpy(&rnp->ipv4_addr, hp->h_addr, hp->h_length);
826 free(rnp->name);
827
828 /* And again: */
829 rnp->name = strdup(remote[n_remote]);
830 if (strchr(rnp->name, ':') == NULL) {
831 fprintf(stderr, "Remote network '%s' is not "
832 "'host:portnr'?\n", rnp->name);
833 exit(1);
834 }
835 rnp->portnr = atoi(strchr(rnp->name, ':') + 1);
836 }
837 }
838
839 if (init_flags & NET_INIT_FLAG_GATEWAY)
840 net_gateway_init(net);
841
842 net_dumpinfo(net);
843
844 /* This is necessary when using the real network: */
845 signal(SIGPIPE, SIG_IGN);
846
847 return net;
848 }
849

  ViewVC Help
Powered by ViewVC 1.1.26