save/restore debug regs, kick DR intercepts to userspace
[freebsd-src/fkvm-freebsd.git] / contrib / libpcap / pcap-dos.c
blob0700d6b1cb146dac55ba648550b39d3cab080657
1 /*
2 * This file is part of DOS-libpcap
3 * Ported to DOS/DOSX by G. Vanem <giva@bgnett.no>
5 * pcap-dos.c: Interface to PKTDRVR, NDIS2 and 32-bit pmode
6 * network drivers.
8 * @(#) $Header: /tcpdump/master/libpcap/pcap-dos.c,v 1.1.2.1 2005/05/03 18:54:35 guy Exp $ (LBL)
9 */
11 #include <stdio.h>
12 #include <stdlib.h>
13 #include <string.h>
14 #include <signal.h>
15 #include <float.h>
16 #include <fcntl.h>
17 #include <io.h>
19 #if defined(USE_32BIT_DRIVERS)
20 #include "msdos/pm_drvr/pmdrvr.h"
21 #include "msdos/pm_drvr/pci.h"
22 #include "msdos/pm_drvr/bios32.h"
23 #include "msdos/pm_drvr/module.h"
24 #include "msdos/pm_drvr/3c501.h"
25 #include "msdos/pm_drvr/3c503.h"
26 #include "msdos/pm_drvr/3c509.h"
27 #include "msdos/pm_drvr/3c59x.h"
28 #include "msdos/pm_drvr/3c515.h"
29 #include "msdos/pm_drvr/3c90x.h"
30 #include "msdos/pm_drvr/3c575_cb.h"
31 #include "msdos/pm_drvr/ne.h"
32 #include "msdos/pm_drvr/wd.h"
33 #include "msdos/pm_drvr/accton.h"
34 #include "msdos/pm_drvr/cs89x0.h"
35 #include "msdos/pm_drvr/rtl8139.h"
36 #include "msdos/pm_drvr/ne2k-pci.h"
37 #endif
39 #include "pcap.h"
40 #include "pcap-dos.h"
41 #include "pcap-int.h"
42 #include "msdos/pktdrvr.h"
44 #ifdef USE_NDIS2
45 #include "msdos/ndis2.h"
46 #endif
48 #include <arpa/inet.h>
49 #include <net/if.h>
50 #include <net/if_arp.h>
51 #include <net/if_ether.h>
52 #include <net/if_packe.h>
53 #include <tcp.h>
55 #if defined(USE_32BIT_DRIVERS)
56 #define FLUSHK() do { _printk_safe = 1; _printk_flush(); } while (0)
57 #define NDIS_NEXT_DEV &rtl8139_dev
59 static char *rx_pool = NULL;
60 static void init_32bit (void);
62 static int pktq_init (struct rx_ringbuf *q, int size, int num, char *pool);
63 static int pktq_check (struct rx_ringbuf *q);
64 static int pktq_inc_out (struct rx_ringbuf *q);
65 static int pktq_in_index (struct rx_ringbuf *q) LOCKED_FUNC;
66 static void pktq_clear (struct rx_ringbuf *q) LOCKED_FUNC;
68 static struct rx_elem *pktq_in_elem (struct rx_ringbuf *q) LOCKED_FUNC;
69 static struct rx_elem *pktq_out_elem (struct rx_ringbuf *q);
71 #else
72 #define FLUSHK() ((void)0)
73 #define NDIS_NEXT_DEV NULL
74 #endif
77 * Internal variables/functions in Watt-32
79 extern WORD _pktdevclass;
80 extern BOOL _eth_is_init;
81 extern int _w32_dynamic_host;
82 extern int _watt_do_exit;
83 extern int _watt_is_init;
84 extern int _w32__bootp_on, _w32__dhcp_on, _w32__rarp_on, _w32__do_mask_req;
85 extern void (*_w32_usr_post_init) (void);
86 extern void (*_w32_print_hook)();
88 extern void dbug_write (const char *); /* Watt-32 lib, pcdbug.c */
89 extern int pkt_get_mtu (void);
91 static int ref_count = 0;
93 static u_long mac_count = 0;
94 static u_long filter_count = 0;
96 static volatile BOOL exc_occured = 0;
98 static struct device *handle_to_device [20];
100 static int pcap_read_dos (pcap_t *p, int cnt, pcap_handler callback,
101 u_char *data);
102 static void pcap_close_dos (pcap_t *p);
103 static int pcap_stats_dos (pcap_t *p, struct pcap_stat *ps);
104 static int pcap_sendpacket_dos (pcap_t *p, const void *buf, size_t len);
105 static int pcap_setfilter_dos (pcap_t *p, struct bpf_program *fp);
107 static int ndis_probe (struct device *dev);
108 static int pkt_probe (struct device *dev);
110 static void close_driver (void);
111 static int init_watt32 (struct pcap *pcap, const char *dev_name, char *err_buf);
112 static int first_init (const char *name, char *ebuf, int promisc);
114 static void watt32_recv_hook (u_char *dummy, const struct pcap_pkthdr *pcap,
115 const u_char *buf);
118 * These are the device we always support
120 static struct device ndis_dev = {
121 "ndis",
122 "NDIS2 LanManager",
124 0,0,0,0,0,0,
125 NDIS_NEXT_DEV, /* NULL or a 32-bit device */
126 ndis_probe
129 static struct device pkt_dev = {
130 "pkt",
131 "Packet-Driver",
133 0,0,0,0,0,0,
134 &ndis_dev,
135 pkt_probe
138 static struct device *get_device (int fd)
140 if (fd <= 0 || fd >= sizeof(handle_to_device)/sizeof(handle_to_device[0]))
141 return (NULL);
142 return handle_to_device [fd-1];
146 * Open MAC-driver with name 'device_name' for live capture of
147 * network packets.
149 pcap_t *pcap_open_live (const char *device_name, int snaplen, int promisc,
150 int timeout_ms, char *errbuf)
152 struct pcap *pcap;
154 if (snaplen < ETH_MIN)
155 snaplen = ETH_MIN;
157 if (snaplen > ETH_MAX) /* silently accept and truncate large MTUs */
158 snaplen = ETH_MAX;
160 pcap = calloc (sizeof(*pcap), 1);
161 if (!pcap)
163 strcpy (errbuf, "Not enough memory (pcap)");
164 return (NULL);
167 pcap->snapshot = max (ETH_MIN+8, snaplen);
168 pcap->linktype = DLT_EN10MB; /* !! */
169 pcap->inter_packet_wait = timeout_ms;
170 pcap->close_op = pcap_close_dos;
171 pcap->read_op = pcap_read_dos;
172 pcap->stats_op = pcap_stats_dos;
173 pcap->inject_op = pcap_sendpacket_dos;
174 pcap->setfilter_op = pcap_setfilter_dos;
175 pcap->setdirection_op = NULL; /* Not implemented.*/
176 pcap->fd = ++ref_count;
178 if (pcap->fd == 1) /* first time we're called */
180 if (!init_watt32(pcap, device_name, errbuf) ||
181 !first_init(device_name, errbuf, promisc))
183 free (pcap);
184 return (NULL);
186 atexit (close_driver);
188 else if (stricmp(active_dev->name,device_name))
190 snprintf (errbuf, PCAP_ERRBUF_SIZE,
191 "Cannot use different devices simultaneously "
192 "(`%s' vs. `%s')", active_dev->name, device_name);
193 free (pcap);
194 pcap = NULL;
196 handle_to_device [pcap->fd-1] = active_dev;
197 return (pcap);
201 * Poll the receiver queue and call the pcap callback-handler
202 * with the packet.
204 static int
205 pcap_read_one (pcap_t *p, pcap_handler callback, u_char *data)
207 struct pcap_pkthdr pcap;
208 struct bpf_insn *fcode = p->fcode.bf_insns;
209 struct timeval now, expiry;
210 BYTE *rx_buf;
211 int rx_len = 0;
213 if (p->inter_packet_wait > 0)
215 gettimeofday2 (&now, NULL);
216 expiry.tv_usec = now.tv_usec + 1000UL * p->inter_packet_wait;
217 expiry.tv_sec = now.tv_sec;
218 while (expiry.tv_usec >= 1000000L)
220 expiry.tv_usec -= 1000000L;
221 expiry.tv_sec++;
225 while (!exc_occured)
227 volatile struct device *dev; /* might be reset by sig_handler */
229 dev = get_device (p->fd);
230 if (!dev)
231 break;
233 PCAP_ASSERT (dev->copy_rx_buf || dev->peek_rx_buf);
234 FLUSHK();
236 /* If driver has a zero-copy receive facility, peek at the queue,
237 * filter it, do the callback and release the buffer.
239 if (dev->peek_rx_buf)
241 PCAP_ASSERT (dev->release_rx_buf);
242 rx_len = (*dev->peek_rx_buf) (&rx_buf);
244 else
246 BYTE buf [ETH_MAX+100]; /* add some margin */
247 rx_len = (*dev->copy_rx_buf) (buf, p->snapshot);
248 rx_buf = buf;
251 if (rx_len > 0) /* got a packet */
253 mac_count++;
255 FLUSHK();
257 pcap.caplen = min (rx_len, p->snapshot);
258 pcap.len = rx_len;
260 if (callback &&
261 (!fcode || bpf_filter(fcode, rx_buf, pcap.len, pcap.caplen)))
263 filter_count++;
265 /* Fix-me!! Should be time of arrival. Not time of
266 * capture.
268 gettimeofday2 (&pcap.ts, NULL);
269 (*callback) (data, &pcap, rx_buf);
272 if (dev->release_rx_buf)
273 (*dev->release_rx_buf) (rx_buf);
275 if (pcap_pkt_debug > 0)
277 if (callback == watt32_recv_hook)
278 dbug_write ("pcap_recv_hook\n");
279 else dbug_write ("pcap_read_op\n");
281 FLUSHK();
282 return (1);
285 /* If not to wait for a packet or pcap_close() called from
286 * e.g. SIGINT handler, exit loop now.
288 if (p->inter_packet_wait <= 0 || (volatile int)p->fd <= 0)
289 break;
291 gettimeofday2 (&now, NULL);
293 if (timercmp(&now, &expiry, >))
294 break;
296 #ifndef DJGPP
297 kbhit(); /* a real CPU hog */
298 #endif
300 if (p->wait_proc)
301 (*p->wait_proc)(); /* call yield func */
304 if (rx_len < 0) /* receive error */
306 p->md.stat.ps_drop++;
307 #ifdef USE_32BIT_DRIVERS
308 if (pcap_pkt_debug > 1)
309 printk ("pkt-err %s\n", pktInfo.error);
310 #endif
311 return (-1);
313 return (0);
316 static int
317 pcap_read_dos (pcap_t *p, int cnt, pcap_handler callback, u_char *data)
319 int rc, num = 0;
321 while (num <= cnt || (cnt < 0))
323 if (p->fd <= 0)
324 return (-1);
325 rc = pcap_read_one (p, callback, data);
326 if (rc > 0)
327 num++;
328 if (rc < 0)
329 break;
330 _w32_os_yield(); /* allow SIGINT generation, yield to Win95/NT */
332 return (num);
336 * Return network statistics
338 static int pcap_stats_dos (pcap_t *p, struct pcap_stat *ps)
340 struct net_device_stats *stats;
341 struct device *dev = p ? get_device(p->fd) : NULL;
343 if (!dev)
345 strcpy (p->errbuf, "illegal pcap handle");
346 return (-1);
349 if (!dev->get_stats || (stats = (*dev->get_stats)(dev)) == NULL)
351 strcpy (p->errbuf, "device statistics not available");
352 return (-1);
355 FLUSHK();
357 p->md.stat.ps_recv = stats->rx_packets;
358 p->md.stat.ps_drop += stats->rx_missed_errors;
359 p->md.stat.ps_ifdrop = stats->rx_dropped + /* queue full */
360 stats->rx_errors; /* HW errors */
361 if (ps)
362 *ps = p->md.stat;
364 return (0);
368 * Return detailed network/device statistics.
369 * May be called after 'dev->close' is called.
371 int pcap_stats_ex (pcap_t *p, struct pcap_stat_ex *se)
373 struct device *dev = p ? get_device (p->fd) : NULL;
375 if (!dev || !dev->get_stats)
377 strlcpy (p->errbuf, "detailed device statistics not available",
378 PCAP_ERRBUF_SIZE);
379 return (-1);
382 if (!strnicmp(dev->name,"pkt",3))
384 strlcpy (p->errbuf, "pktdrvr doesn't have detailed statistics",
385 PCAP_ERRBUF_SIZE);
386 return (-1);
388 memcpy (se, (*dev->get_stats)(dev), sizeof(*se));
389 return (0);
393 * Simply store the filter-code for the pcap_read_dos() callback
394 * Some day the filter-code could be handed down to the active
395 * device (pkt_rx1.s or 32-bit device interrupt handler).
397 static int pcap_setfilter_dos (pcap_t *p, struct bpf_program *fp)
399 if (!p)
400 return (-1);
401 p->fcode = *fp;
402 return (0);
406 * Return # of packets received in pcap_read_dos()
408 u_long pcap_mac_packets (void)
410 return (mac_count);
414 * Return # of packets passed through filter in pcap_read_dos()
416 u_long pcap_filter_packets (void)
418 return (filter_count);
422 * Close pcap device. Not called for offline captures.
424 static void pcap_close_dos (pcap_t *p)
426 if (p && !exc_occured)
428 if (pcap_stats(p,NULL) < 0)
429 p->md.stat.ps_drop = 0;
430 if (!get_device(p->fd))
431 return;
433 handle_to_device [p->fd-1] = NULL;
434 p->fd = 0;
435 if (ref_count > 0)
436 ref_count--;
437 if (ref_count > 0)
438 return;
440 close_driver();
444 * Return the name of the 1st network interface,
445 * or NULL if none can be found.
447 char *pcap_lookupdev (char *ebuf)
449 struct device *dev;
451 #ifdef USE_32BIT_DRIVERS
452 init_32bit();
453 #endif
455 for (dev = (struct device*)dev_base; dev; dev = dev->next)
457 PCAP_ASSERT (dev->probe);
459 if ((*dev->probe)(dev))
461 FLUSHK();
462 probed_dev = (struct device*) dev; /* remember last probed device */
463 return (char*) dev->name;
467 if (ebuf)
468 strcpy (ebuf, "No driver found");
469 return (NULL);
473 * Gets localnet & netmask from Watt-32.
475 int pcap_lookupnet (const char *device, bpf_u_int32 *localnet,
476 bpf_u_int32 *netmask, char *errbuf)
478 if (!_watt_is_init)
480 strcpy (errbuf, "pcap_open_offline() or pcap_open_live() must be "
481 "called first");
482 return (-1);
485 *netmask = _w32_sin_mask;
486 *localnet = my_ip_addr & *netmask;
487 if (*localnet == 0)
489 if (IN_CLASSA(*netmask))
490 *localnet = IN_CLASSA_NET;
491 else if (IN_CLASSB(*netmask))
492 *localnet = IN_CLASSB_NET;
493 else if (IN_CLASSC(*netmask))
494 *localnet = IN_CLASSC_NET;
495 else
497 sprintf (errbuf, "inet class for 0x%lx unknown", *netmask);
498 return (-1);
501 ARGSUSED (device);
502 return (0);
506 * Get a list of all interfaces that are present and that we probe okay.
507 * Returns -1 on error, 0 otherwise.
508 * The list, as returned through "alldevsp", may be null if no interfaces
509 * were up and could be opened.
511 int pcap_findalldevs (pcap_if_t **alldevsp, char *errbuf)
513 struct device *dev;
514 struct sockaddr_ll sa_ll_1, sa_ll_2;
515 struct sockaddr *addr, *netmask, *broadaddr, *dstaddr;
516 pcap_if_t *devlist = NULL;
517 int ret = 0;
518 size_t addr_size = sizeof(struct sockaddr_ll);
520 for (dev = (struct device*)dev_base; dev; dev = dev->next)
522 PCAP_ASSERT (dev->probe);
524 if (!(*dev->probe)(dev))
525 continue;
527 PCAP_ASSERT (dev->close); /* set by probe routine */
528 FLUSHK();
529 (*dev->close) (dev);
531 memset (&sa_ll_1, 0, sizeof(sa_ll_1));
532 memset (&sa_ll_2, 0, sizeof(sa_ll_2));
533 sa_ll_1.sll_family = AF_PACKET;
534 sa_ll_2.sll_family = AF_PACKET;
536 addr = (struct sockaddr*) &sa_ll_1;
537 netmask = (struct sockaddr*) &sa_ll_1;
538 dstaddr = (struct sockaddr*) &sa_ll_1;
539 broadaddr = (struct sockaddr*) &sa_ll_2;
540 memset (&sa_ll_2.sll_addr, 0xFF, sizeof(sa_ll_2.sll_addr));
542 if (pcap_add_if(&devlist, dev->name, dev->flags,
543 dev->long_name, errbuf) < 0)
545 ret = -1;
546 break;
548 if (add_addr_to_iflist(&devlist,dev->name, dev->flags, addr, addr_size,
549 netmask, addr_size, broadaddr, addr_size,
550 dstaddr, addr_size, errbuf) < 0)
552 ret = -1;
553 break;
557 if (devlist && ret < 0)
559 pcap_freealldevs (devlist);
560 devlist = NULL;
562 else
563 if (!devlist)
564 strcpy (errbuf, "No drivers found");
566 *alldevsp = devlist;
567 return (ret);
571 * pcap_assert() is mainly used for debugging
573 void pcap_assert (const char *what, const char *file, unsigned line)
575 FLUSHK();
576 fprintf (stderr, "%s (%u): Assertion \"%s\" failed\n",
577 file, line, what);
578 close_driver();
579 _exit (-1);
583 * For pcap_offline_read(): wait and yield between printing packets
584 * to simulate the pace packets where actually recorded.
586 void pcap_set_wait (pcap_t *p, void (*yield)(void), int wait)
588 if (p)
590 p->wait_proc = yield;
591 p->inter_packet_wait = wait;
596 * Initialise a named network device.
598 static struct device *
599 open_driver (const char *dev_name, char *ebuf, int promisc)
601 struct device *dev;
603 for (dev = (struct device*)dev_base; dev; dev = dev->next)
605 PCAP_ASSERT (dev->name);
607 if (strcmp (dev_name,dev->name))
608 continue;
610 if (!probed_dev) /* user didn't call pcap_lookupdev() first */
612 PCAP_ASSERT (dev->probe);
614 if (!(*dev->probe)(dev)) /* call the xx_probe() function */
616 sprintf (ebuf, "failed to detect device `%s'", dev_name);
617 return (NULL);
619 probed_dev = dev; /* device is probed okay and may be used */
621 else if (dev != probed_dev)
623 goto not_probed;
626 FLUSHK();
628 /* Select what traffic to receive
630 if (promisc)
631 dev->flags |= (IFF_ALLMULTI | IFF_PROMISC);
632 else dev->flags &= ~(IFF_ALLMULTI | IFF_PROMISC);
634 PCAP_ASSERT (dev->open);
636 if (!(*dev->open)(dev))
638 sprintf (ebuf, "failed to activate device `%s'", dev_name);
639 if (pktInfo.error && !strncmp(dev->name,"pkt",3))
641 strcat (ebuf, ": ");
642 strcat (ebuf, pktInfo.error);
644 return (NULL);
647 /* Some devices need this to operate in promiscous mode
649 if (promisc && dev->set_multicast_list)
650 (*dev->set_multicast_list) (dev);
652 active_dev = dev; /* remember our active device */
653 break;
656 /* 'dev_name' not matched in 'dev_base' list.
658 if (!dev)
660 sprintf (ebuf, "device `%s' not supported", dev_name);
661 return (NULL);
664 not_probed:
665 if (!probed_dev)
667 sprintf (ebuf, "device `%s' not probed", dev_name);
668 return (NULL);
670 return (dev);
674 * Deinitialise MAC driver.
675 * Set receive mode back to default mode.
677 static void close_driver (void)
679 /* !!todo: loop over all 'handle_to_device[]' ? */
680 struct device *dev = active_dev;
682 if (dev && dev->close)
684 (*dev->close) (dev);
685 FLUSHK();
688 active_dev = NULL;
690 #ifdef USE_32BIT_DRIVERS
691 if (rx_pool)
693 k_free (rx_pool);
694 rx_pool = NULL;
696 if (dev)
697 pcibios_exit();
698 #endif
702 #ifdef __DJGPP__
703 static void setup_signals (void (*handler)(int))
705 signal (SIGSEGV,handler);
706 signal (SIGILL, handler);
707 signal (SIGFPE, handler);
710 static void exc_handler (int sig)
712 #ifdef USE_32BIT_DRIVERS
713 if (active_dev->irq > 0) /* excludes IRQ 0 */
715 disable_irq (active_dev->irq);
716 irq_eoi_cmd (active_dev->irq);
717 _printk_safe = 1;
719 #endif
721 switch (sig)
723 case SIGSEGV:
724 fputs ("Catching SIGSEGV.\n", stderr);
725 break;
726 case SIGILL:
727 fputs ("Catching SIGILL.\n", stderr);
728 break;
729 case SIGFPE:
730 _fpreset();
731 fputs ("Catching SIGFPE.\n", stderr);
732 break;
733 default:
734 fprintf (stderr, "Catching signal %d.\n", sig);
736 exc_occured = 1;
737 pcap_close_dos (NULL);
739 #endif /* __DJGPP__ */
743 * Open the pcap device for the first client calling pcap_open_live()
745 static int first_init (const char *name, char *ebuf, int promisc)
747 struct device *dev;
749 #ifdef USE_32BIT_DRIVERS
750 rx_pool = k_calloc (RECEIVE_BUF_SIZE, RECEIVE_QUEUE_SIZE);
751 if (!rx_pool)
753 strcpy (ebuf, "Not enough memory (Rx pool)");
754 return (0);
756 #endif
758 #ifdef __DJGPP__
759 setup_signals (exc_handler);
760 #endif
762 #ifdef USE_32BIT_DRIVERS
763 init_32bit();
764 #endif
766 dev = open_driver (name, ebuf, promisc);
767 if (!dev)
769 #ifdef USE_32BIT_DRIVERS
770 k_free (rx_pool);
771 rx_pool = NULL;
772 #endif
774 #ifdef __DJGPP__
775 setup_signals (SIG_DFL);
776 #endif
777 return (0);
780 #ifdef USE_32BIT_DRIVERS
782 * If driver is NOT a 16-bit "pkt/ndis" driver (having a 'copy_rx_buf'
783 * set in it's probe handler), initialise near-memory ring-buffer for
784 * the 32-bit device.
786 if (dev->copy_rx_buf == NULL)
788 dev->get_rx_buf = get_rxbuf;
789 dev->peek_rx_buf = peek_rxbuf;
790 dev->release_rx_buf = release_rxbuf;
791 pktq_init (&dev->queue, RECEIVE_BUF_SIZE, RECEIVE_QUEUE_SIZE, rx_pool);
793 #endif
794 return (1);
797 #ifdef USE_32BIT_DRIVERS
798 static void init_32bit (void)
800 static int init_pci = 0;
802 if (!_printk_file)
803 _printk_init (64*1024, NULL); /* calls atexit(printk_exit) */
805 if (!init_pci)
806 (void)pci_init(); /* init BIOS32+PCI interface */
807 init_pci = 1;
809 #endif
813 * Hook functions for using Watt-32 together with pcap
815 static char rxbuf [ETH_MAX+100]; /* rx-buffer with some margin */
816 static WORD etype;
817 static pcap_t pcap_save;
819 static void watt32_recv_hook (u_char *dummy, const struct pcap_pkthdr *pcap,
820 const u_char *buf)
822 /* Fix me: assumes Ethernet II only */
823 struct ether_header *ep = (struct ether_header*) buf;
825 memcpy (rxbuf, buf, pcap->caplen);
826 etype = ep->ether_type;
827 ARGSUSED (dummy);
830 #if (WATTCP_VER >= 0x0224)
832 * This function is used by Watt-32 to poll for a packet.
833 * i.e. it's set to bypass _eth_arrived()
835 static void *pcap_recv_hook (WORD *type)
837 int len = pcap_read_dos (&pcap_save, 1, watt32_recv_hook, NULL);
839 if (len < 0)
840 return (NULL);
842 *type = etype;
843 return (void*) &rxbuf;
847 * This function is called by Watt-32 (via _eth_xmit_hook).
848 * If dbug_init() was called, we should trace packets sent.
850 static int pcap_xmit_hook (const void *buf, unsigned len)
852 int rc = 0;
854 if (pcap_pkt_debug > 0)
855 dbug_write ("pcap_xmit_hook: ");
857 if (active_dev && active_dev->xmit)
858 if ((*active_dev->xmit) (active_dev, buf, len) > 0)
859 rc = len;
861 if (pcap_pkt_debug > 0)
862 dbug_write (rc ? "ok\n" : "fail\n");
863 return (rc);
865 #endif
867 static int pcap_sendpacket_dos (pcap_t *p, const void *buf, size_t len)
869 struct device *dev = p ? get_device(p->fd) : NULL;
871 if (!dev || !dev->xmit)
872 return (-1);
873 return (*dev->xmit) (dev, buf, len);
877 * This function is called by Watt-32 in tcp_post_init().
878 * We should prevent Watt-32 from using BOOTP/DHCP/RARP etc.
880 static void (*prev_post_hook) (void);
882 static void pcap_init_hook (void)
884 _w32__bootp_on = _w32__dhcp_on = _w32__rarp_on = 0;
885 _w32__do_mask_req = 0;
886 _w32_dynamic_host = 0;
887 if (prev_post_hook)
888 (*prev_post_hook)();
892 * Supress PRINT message from Watt-32's sock_init()
894 static void null_print (void) {}
897 * To use features of Watt-32 (netdb functions and socket etc.)
898 * we must call sock_init(). But we set various hooks to prevent
899 * using normal PKTDRVR functions in pcpkt.c. This should hopefully
900 * make Watt-32 and pcap co-operate.
902 static int init_watt32 (struct pcap *pcap, const char *dev_name, char *err_buf)
904 char *env;
905 int rc, MTU, has_ip_addr;
906 int using_pktdrv = 1;
908 /* If user called sock_init() first, we need to reinit in
909 * order to open debug/trace-file properly
911 if (_watt_is_init)
912 sock_exit();
914 env = getenv ("PCAP_DEBUG");
915 if (env && atoi(env) > 0 &&
916 pcap_pkt_debug < 0) /* if not already set */
918 dbug_init();
919 pcap_pkt_debug = atoi (env);
922 _watt_do_exit = 0; /* prevent sock_init() calling exit() */
923 prev_post_hook = _w32_usr_post_init;
924 _w32_usr_post_init = pcap_init_hook;
925 _w32_print_hook = null_print;
927 if (dev_name && strncmp(dev_name,"pkt",3))
928 using_pktdrv = FALSE;
930 rc = sock_init();
931 has_ip_addr = (rc != 8); /* IP-address assignment failed */
933 /* if pcap is using a 32-bit driver w/o a pktdrvr loaded, we
934 * just pretend Watt-32 is initialised okay.
936 * !! fix-me: The Watt-32 config isn't done if no pktdrvr
937 * was found. In that case my_ip_addr + sin_mask
938 * have default values. Should be taken from another
939 * ini-file/environment in any case (ref. tcpdump.ini)
941 _watt_is_init = 1;
943 if (!using_pktdrv || !has_ip_addr) /* for now .... */
945 static const char myip[] = "192.168.0.1";
946 static const char mask[] = "255.255.255.0";
948 printf ("Just guessing, using IP %s and netmask %s\n", myip, mask);
949 my_ip_addr = aton (myip);
950 _w32_sin_mask = aton (mask);
952 else if (rc && using_pktdrv)
954 sprintf (err_buf, "sock_init() failed, code %d", rc);
955 return (0);
958 /* Set recv-hook for peeking in _eth_arrived().
960 #if (WATTCP_VER >= 0x0224)
961 _eth_recv_hook = pcap_recv_hook;
962 _eth_xmit_hook = pcap_xmit_hook;
963 #endif
965 /* Free the pkt-drvr handle allocated in pkt_init().
966 * The above hooks should thus use the handle reopened in open_driver()
968 if (using_pktdrv)
970 _eth_release();
971 /* _eth_is_init = 1; */ /* hack to get Rx/Tx-hooks in Watt-32 working */
974 memcpy (&pcap_save, pcap, sizeof(pcap_save));
975 MTU = pkt_get_mtu();
976 pcap_save.fcode.bf_insns = NULL;
977 pcap_save.linktype = _eth_get_hwtype (NULL, NULL);
978 pcap_save.snapshot = MTU > 0 ? MTU : ETH_MAX; /* assume 1514 */
980 #if 1
981 /* prevent use of resolve() and resolve_ip()
983 last_nameserver = 0;
984 #endif
985 return (1);
988 int EISA_bus = 0; /* Where is natural place for this? */
991 * Application config hooks to set various driver parameters.
994 static struct config_table debug_tab[] = {
995 { "PKT.DEBUG", ARG_ATOI, &pcap_pkt_debug },
996 { "PKT.VECTOR", ARG_ATOX_W, NULL },
997 { "NDIS.DEBUG", ARG_ATOI, NULL },
998 #ifdef USE_32BIT_DRIVERS
999 { "3C503.DEBUG", ARG_ATOI, &ei_debug },
1000 { "3C503.IO_BASE", ARG_ATOX_W, &el2_dev.base_addr },
1001 { "3C503.MEMORY", ARG_ATOX_W, &el2_dev.mem_start },
1002 { "3C503.IRQ", ARG_ATOI, &el2_dev.irq },
1003 { "3C505.DEBUG", ARG_ATOI, NULL },
1004 { "3C505.BASE", ARG_ATOX_W, NULL },
1005 { "3C507.DEBUG", ARG_ATOI, NULL },
1006 { "3C509.DEBUG", ARG_ATOI, &el3_debug },
1007 { "3C509.ILOOP", ARG_ATOI, &el3_max_loop },
1008 { "3C529.DEBUG", ARG_ATOI, NULL },
1009 { "3C575.DEBUG", ARG_ATOI, &debug_3c575 },
1010 { "3C59X.DEBUG", ARG_ATOI, &vortex_debug },
1011 { "3C59X.IFACE0", ARG_ATOI, &vortex_options[0] },
1012 { "3C59X.IFACE1", ARG_ATOI, &vortex_options[1] },
1013 { "3C59X.IFACE2", ARG_ATOI, &vortex_options[2] },
1014 { "3C59X.IFACE3", ARG_ATOI, &vortex_options[3] },
1015 { "3C90X.DEBUG", ARG_ATOX_W, &tc90xbc_debug },
1016 { "ACCT.DEBUG", ARG_ATOI, &ethpk_debug },
1017 { "CS89.DEBUG", ARG_ATOI, &cs89_debug },
1018 { "RTL8139.DEBUG", ARG_ATOI, &rtl8139_debug },
1019 /* { "RTL8139.FDUPLEX", ARG_ATOI, &rtl8139_options }, */
1020 { "SMC.DEBUG", ARG_ATOI, &ei_debug },
1021 /* { "E100.DEBUG", ARG_ATOI, &e100_debug }, */
1022 { "PCI.DEBUG", ARG_ATOI, &pci_debug },
1023 { "BIOS32.DEBUG", ARG_ATOI, &bios32_debug },
1024 { "IRQ.DEBUG", ARG_ATOI, &irq_debug },
1025 { "TIMER.IRQ", ARG_ATOI, &timer_irq },
1026 #endif
1027 { NULL }
1031 * pcap_config_hook() is an extension to application's config
1032 * handling. Uses Watt-32's config-table function.
1034 int pcap_config_hook (const char *name, const char *value)
1036 return parse_config_table (debug_tab, NULL, name, value);
1040 * Linked list of supported devices
1042 struct device *active_dev = NULL; /* the device we have opened */
1043 struct device *probed_dev = NULL; /* the device we have probed */
1044 const struct device *dev_base = &pkt_dev; /* list of network devices */
1047 * PKTDRVR device functions
1049 int pcap_pkt_debug = -1;
1051 static void pkt_close (struct device *dev)
1053 BOOL okay = PktExitDriver();
1055 if (pcap_pkt_debug > 1)
1056 fprintf (stderr, "pkt_close(): %d\n", okay);
1058 if (dev->priv)
1059 free (dev->priv);
1060 dev->priv = NULL;
1063 static int pkt_open (struct device *dev)
1065 PKT_RX_MODE mode;
1067 if (dev->flags & IFF_PROMISC)
1068 mode = PDRX_ALL_PACKETS;
1069 else mode = PDRX_BROADCAST;
1071 if (!PktInitDriver(mode))
1072 return (0);
1074 PktResetStatistics (pktInfo.handle);
1075 PktQueueBusy (FALSE);
1076 return (1);
1079 static int pkt_xmit (struct device *dev, const void *buf, int len)
1081 struct net_device_stats *stats = (struct net_device_stats*) dev->priv;
1083 if (pcap_pkt_debug > 0)
1084 dbug_write ("pcap_xmit\n");
1086 if (!PktTransmit(buf,len))
1088 stats->tx_errors++;
1089 return (0);
1091 return (len);
1094 static void *pkt_stats (struct device *dev)
1096 struct net_device_stats *stats = (struct net_device_stats*) dev->priv;
1098 if (!stats || !PktSessStatistics(pktInfo.handle))
1099 return (NULL);
1101 stats->rx_packets = pktStat.inPackets;
1102 stats->rx_errors = pktStat.lost;
1103 stats->rx_missed_errors = PktRxDropped();
1104 return (stats);
1107 static int pkt_probe (struct device *dev)
1109 if (!PktSearchDriver())
1110 return (0);
1112 dev->open = pkt_open;
1113 dev->xmit = pkt_xmit;
1114 dev->close = pkt_close;
1115 dev->get_stats = pkt_stats;
1116 dev->copy_rx_buf = PktReceive; /* farmem peek and copy routine */
1117 dev->get_rx_buf = NULL;
1118 dev->peek_rx_buf = NULL;
1119 dev->release_rx_buf = NULL;
1120 dev->priv = calloc (sizeof(struct net_device_stats), 1);
1121 if (!dev->priv)
1122 return (0);
1123 return (1);
1127 * NDIS device functions
1129 static void ndis_close (struct device *dev)
1131 #ifdef USE_NDIS2
1132 NdisShutdown();
1133 #endif
1134 ARGSUSED (dev);
1137 static int ndis_open (struct device *dev)
1139 int promis = (dev->flags & IFF_PROMISC);
1141 #ifdef USE_NDIS2
1142 if (!NdisInit(promis))
1143 return (0);
1144 return (1);
1145 #else
1146 ARGSUSED (promis);
1147 return (0);
1148 #endif
1151 static void *ndis_stats (struct device *dev)
1153 static struct net_device_stats stats;
1155 /* to-do */
1156 ARGSUSED (dev);
1157 return (&stats);
1160 static int ndis_probe (struct device *dev)
1162 #ifdef USE_NDIS2
1163 if (!NdisOpen())
1164 return (0);
1165 #endif
1167 dev->open = ndis_open;
1168 dev->xmit = NULL;
1169 dev->close = ndis_close;
1170 dev->get_stats = ndis_stats;
1171 dev->copy_rx_buf = NULL; /* to-do */
1172 dev->get_rx_buf = NULL; /* upcall is from rmode driver */
1173 dev->peek_rx_buf = NULL;
1174 dev->release_rx_buf = NULL;
1175 return (0);
1179 * Search & probe for supported 32-bit (pmode) pcap devices
1181 #if defined(USE_32BIT_DRIVERS)
1183 struct device el2_dev LOCKED_VAR = {
1184 "3c503",
1185 "EtherLink II",
1187 0,0,0,0,0,0,
1188 NULL,
1189 el2_probe
1192 struct device el3_dev LOCKED_VAR = {
1193 "3c509",
1194 "EtherLink III",
1196 0,0,0,0,0,0,
1197 &el2_dev,
1198 el3_probe
1201 struct device tc515_dev LOCKED_VAR = {
1202 "3c515",
1203 "EtherLink PCI",
1205 0,0,0,0,0,0,
1206 &el3_dev,
1207 tc515_probe
1210 struct device tc59_dev LOCKED_VAR = {
1211 "3c59x",
1212 "EtherLink PCI",
1214 0,0,0,0,0,0,
1215 &tc515_dev,
1216 tc59x_probe
1219 struct device tc90xbc_dev LOCKED_VAR = {
1220 "3c90x",
1221 "EtherLink 90X",
1223 0,0,0,0,0,0,
1224 &tc59_dev,
1225 tc90xbc_probe
1228 struct device wd_dev LOCKED_VAR = {
1229 "wd",
1230 "Westen Digital",
1232 0,0,0,0,0,0,
1233 &tc90xbc_dev,
1234 wd_probe
1237 struct device ne_dev LOCKED_VAR = {
1238 "ne",
1239 "NEx000",
1241 0,0,0,0,0,0,
1242 &wd_dev,
1243 ne_probe
1246 struct device acct_dev LOCKED_VAR = {
1247 "acct",
1248 "Accton EtherPocket",
1250 0,0,0,0,0,0,
1251 &ne_dev,
1252 ethpk_probe
1255 struct device cs89_dev LOCKED_VAR = {
1256 "cs89",
1257 "Crystal Semiconductor",
1259 0,0,0,0,0,0,
1260 &acct_dev,
1261 cs89x0_probe
1264 struct device rtl8139_dev LOCKED_VAR = {
1265 "rtl8139",
1266 "RealTek PCI",
1268 0,0,0,0,0,0,
1269 &cs89_dev,
1270 rtl8139_probe /* dev->probe routine */
1274 * Dequeue routine is called by polling.
1275 * NOTE: the queue-element is not copied, only a pointer is
1276 * returned at '*buf'
1278 int peek_rxbuf (BYTE **buf)
1280 struct rx_elem *tail, *head;
1282 PCAP_ASSERT (pktq_check (&active_dev->queue));
1284 DISABLE();
1285 tail = pktq_out_elem (&active_dev->queue);
1286 head = pktq_in_elem (&active_dev->queue);
1287 ENABLE();
1289 if (head != tail)
1291 PCAP_ASSERT (tail->size < active_dev->queue.elem_size-4-2);
1293 *buf = &tail->data[0];
1294 return (tail->size);
1296 *buf = NULL;
1297 return (0);
1301 * Release buffer we peeked at above.
1303 int release_rxbuf (BYTE *buf)
1305 #ifndef NDEBUG
1306 struct rx_elem *tail = pktq_out_elem (&active_dev->queue);
1308 PCAP_ASSERT (&tail->data[0] == buf);
1309 #else
1310 ARGSUSED (buf);
1311 #endif
1312 pktq_inc_out (&active_dev->queue);
1313 return (1);
1317 * get_rxbuf() routine (in locked code) is called from IRQ handler
1318 * to request a buffer. Interrupts are disabled and we have a 32kB stack.
1320 BYTE *get_rxbuf (int len)
1322 int idx;
1324 if (len < ETH_MIN || len > ETH_MAX)
1325 return (NULL);
1327 idx = pktq_in_index (&active_dev->queue);
1329 #ifdef DEBUG
1331 static int fan_idx LOCKED_VAR = 0;
1332 writew ("-\\|/"[fan_idx++] | (15 << 8), /* white on black colour */
1333 0xB8000 + 2*79); /* upper-right corner, 80-col colour screen */
1334 fan_idx &= 3;
1336 /* writew (idx + '0' + 0x0F00, 0xB8000 + 2*78); */
1337 #endif
1339 if (idx != active_dev->queue.out_index)
1341 struct rx_elem *head = pktq_in_elem (&active_dev->queue);
1343 head->size = len;
1344 active_dev->queue.in_index = idx;
1345 return (&head->data[0]);
1348 /* !!to-do: drop 25% of the oldest element
1350 pktq_clear (&active_dev->queue);
1351 return (NULL);
1355 * Simple ring-buffer queue handler for reception of packets
1356 * from network driver.
1358 #define PKTQ_MARKER 0xDEADBEEF
1360 static int pktq_check (struct rx_ringbuf *q)
1362 #ifndef NDEBUG
1363 int i;
1364 char *buf;
1365 #endif
1367 if (!q || !q->num_elem || !q->buf_start)
1368 return (0);
1370 #ifndef NDEBUG
1371 buf = q->buf_start;
1373 for (i = 0; i < q->num_elem; i++)
1375 buf += q->elem_size;
1376 if (*(DWORD*)(buf - sizeof(DWORD)) != PKTQ_MARKER)
1377 return (0);
1379 #endif
1380 return (1);
1383 static int pktq_init (struct rx_ringbuf *q, int size, int num, char *pool)
1385 int i;
1387 q->elem_size = size;
1388 q->num_elem = num;
1389 q->buf_start = pool;
1390 q->in_index = 0;
1391 q->out_index = 0;
1393 PCAP_ASSERT (size >= sizeof(struct rx_elem) + sizeof(DWORD));
1394 PCAP_ASSERT (num);
1395 PCAP_ASSERT (pool);
1397 for (i = 0; i < num; i++)
1399 #if 0
1400 struct rx_elem *elem = (struct rx_elem*) pool;
1402 /* assert dword aligned elements
1404 PCAP_ASSERT (((unsigned)(&elem->data[0]) & 3) == 0);
1405 #endif
1406 pool += size;
1407 *(DWORD*) (pool - sizeof(DWORD)) = PKTQ_MARKER;
1409 return (1);
1413 * Increment the queue 'out_index' (tail).
1414 * Check for wraps.
1416 static int pktq_inc_out (struct rx_ringbuf *q)
1418 q->out_index++;
1419 if (q->out_index >= q->num_elem)
1420 q->out_index = 0;
1421 return (q->out_index);
1425 * Return the queue's next 'in_index' (head).
1426 * Check for wraps.
1428 static int pktq_in_index (struct rx_ringbuf *q)
1430 volatile int index = q->in_index + 1;
1432 if (index >= q->num_elem)
1433 index = 0;
1434 return (index);
1438 * Return the queue's head-buffer.
1440 static struct rx_elem *pktq_in_elem (struct rx_ringbuf *q)
1442 return (struct rx_elem*) (q->buf_start + (q->elem_size * q->in_index));
1446 * Return the queue's tail-buffer.
1448 static struct rx_elem *pktq_out_elem (struct rx_ringbuf *q)
1450 return (struct rx_elem*) (q->buf_start + (q->elem_size * q->out_index));
1454 * Clear the queue ring-buffer by setting head=tail.
1456 static void pktq_clear (struct rx_ringbuf *q)
1458 q->in_index = q->out_index;
1462 * Symbols that must be linkable for "gcc -O0"
1464 #undef __IOPORT_H
1465 #undef __DMA_H
1467 #define extern
1468 #define __inline__
1470 #include "msdos/pm_drvr/ioport.h"
1471 #include "msdos/pm_drvr/dma.h"
1473 #endif /* USE_32BIT_DRIVERS */