2 * This file is part of DOS-libpcap
3 * Ported to DOS/DOSX by G. Vanem <gvanem@broadpark.no>
5 * pcap-dos.c: Interface to PKTDRVR, NDIS2 and 32-bit pmode
8 * @(#) $Header: /tcpdump/master/libpcap/pcap-dos.c,v 1.2.2.5 2008-04-22 17:16:49 guy Exp $ (LBL)
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"
42 #include "msdos/pktdrvr.h"
45 #include "msdos/ndis2.h"
48 #include <arpa/inet.h>
50 #include <net/if_arp.h>
51 #include <net/if_ether.h>
52 #include <net/if_packe.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
);
72 #define FLUSHK() ((void)0)
73 #define NDIS_NEXT_DEV NULL
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_activate_dos (pcap_t
*p
);
101 static int pcap_read_dos (pcap_t
*p
, int cnt
, pcap_handler callback
,
103 static void pcap_cleanup_dos (pcap_t
*p
);
104 static int pcap_stats_dos (pcap_t
*p
, struct pcap_stat
*ps
);
105 static int pcap_sendpacket_dos (pcap_t
*p
, const void *buf
, size_t len
);
106 static int pcap_setfilter_dos (pcap_t
*p
, struct bpf_program
*fp
);
108 static int ndis_probe (struct device
*dev
);
109 static int pkt_probe (struct device
*dev
);
111 static void close_driver (void);
112 static int init_watt32 (struct pcap
*pcap
, const char *dev_name
, char *err_buf
);
113 static int first_init (const char *name
, char *ebuf
, int promisc
);
115 static void watt32_recv_hook (u_char
*dummy
, const struct pcap_pkthdr
*pcap
,
119 * These are the device we always support
121 static struct device ndis_dev
= {
126 NDIS_NEXT_DEV
, /* NULL or a 32-bit device */
130 static struct device pkt_dev
= {
139 static struct device
*get_device (int fd
)
141 if (fd
<= 0 || fd
>= sizeof(handle_to_device
)/sizeof(handle_to_device
[0]))
143 return handle_to_device
[fd
-1];
146 pcap_t
*pcap_create (const char *device
, char *ebuf
)
150 p
= pcap_create_common(device
, ebuf
);
154 p
->activate_op
= pcap_activate_dos
;
159 * Open MAC-driver with name 'device_name' for live capture of
162 static int pcap_activate_dos (pcap_t
*pcap
)
164 if (pcap
->opt
.rfmon
) {
166 * No monitor mode on DOS.
168 return (PCAP_ERROR_RFMON_NOTSUP
);
171 if (pcap
->snapshot
< ETH_MIN
+8)
172 pcap
->snapshot
= ETH_MIN
+8;
174 if (pcap
->snapshot
> ETH_MAX
) /* silently accept and truncate large MTUs */
175 pcap
->snapshot
= ETH_MAX
;
177 pcap
->linktype
= DLT_EN10MB
; /* !! */
178 pcap
->cleanup_op
= pcap_cleanup_dos
;
179 pcap
->read_op
= pcap_read_dos
;
180 pcap
->stats_op
= pcap_stats_dos
;
181 pcap
->inject_op
= pcap_sendpacket_dos
;
182 pcap
->setfilter_op
= pcap_setfilter_dos
;
183 pcap
->setdirection_op
= NULL
; /* Not implemented.*/
184 pcap
->fd
= ++ref_count
;
186 if (pcap
->fd
== 1) /* first time we're called */
188 if (!init_watt32(pcap
, pcap
->opt
.source
, pcap
->errbuf
) ||
189 !first_init(pcap
->opt
.source
, pcap
->errbuf
, pcap
->opt
.promisc
))
193 atexit (close_driver
);
195 else if (stricmp(active_dev
->name
,pcap
->opt
.source
))
197 snprintf (pcap
->errbuf
, PCAP_ERRBUF_SIZE
,
198 "Cannot use different devices simultaneously "
199 "(`%s' vs. `%s')", active_dev
->name
, pcap
->opt
.source
);
202 handle_to_device
[pcap
->fd
-1] = active_dev
;
207 * Poll the receiver queue and call the pcap callback-handler
211 pcap_read_one (pcap_t
*p
, pcap_handler callback
, u_char
*data
)
213 struct pcap_pkthdr pcap
;
214 struct timeval now
, expiry
;
218 if (p
->md
.timeout
> 0)
220 gettimeofday2 (&now
, NULL
);
221 expiry
.tv_usec
= now
.tv_usec
+ 1000UL * p
->md
.timeout
;
222 expiry
.tv_sec
= now
.tv_sec
;
223 while (expiry
.tv_usec
>= 1000000L)
225 expiry
.tv_usec
-= 1000000L;
232 volatile struct device
*dev
; /* might be reset by sig_handler */
234 dev
= get_device (p
->fd
);
238 PCAP_ASSERT (dev
->copy_rx_buf
|| dev
->peek_rx_buf
);
241 /* If driver has a zero-copy receive facility, peek at the queue,
242 * filter it, do the callback and release the buffer.
244 if (dev
->peek_rx_buf
)
246 PCAP_ASSERT (dev
->release_rx_buf
);
247 rx_len
= (*dev
->peek_rx_buf
) (&rx_buf
);
251 BYTE buf
[ETH_MAX
+100]; /* add some margin */
252 rx_len
= (*dev
->copy_rx_buf
) (buf
, p
->snapshot
);
256 if (rx_len
> 0) /* got a packet */
262 pcap
.caplen
= min (rx_len
, p
->snapshot
);
266 (!p
->fcode
.bf_insns
|| bpf_filter(p
->fcode
.bf_insns
, rx_buf
, pcap
.len
, pcap
.caplen
)))
270 /* Fix-me!! Should be time of arrival. Not time of
273 gettimeofday2 (&pcap
.ts
, NULL
);
274 (*callback
) (data
, &pcap
, rx_buf
);
277 if (dev
->release_rx_buf
)
278 (*dev
->release_rx_buf
) (rx_buf
);
280 if (pcap_pkt_debug
> 0)
282 if (callback
== watt32_recv_hook
)
283 dbug_write ("pcap_recv_hook\n");
284 else dbug_write ("pcap_read_op\n");
290 /* If not to wait for a packet or pcap_close() called from
291 * e.g. SIGINT handler, exit loop now.
293 if (p
->md
.timeout
<= 0 || (volatile int)p
->fd
<= 0)
296 gettimeofday2 (&now
, NULL
);
298 if (timercmp(&now
, &expiry
, >))
302 kbhit(); /* a real CPU hog */
306 (*p
->wait_proc
)(); /* call yield func */
309 if (rx_len
< 0) /* receive error */
311 p
->md
.stat
.ps_drop
++;
312 #ifdef USE_32BIT_DRIVERS
313 if (pcap_pkt_debug
> 1)
314 printk ("pkt-err %s\n", pktInfo
.error
);
322 pcap_read_dos (pcap_t
*p
, int cnt
, pcap_handler callback
, u_char
*data
)
326 while (num
<= cnt
|| (cnt
< 0))
330 rc
= pcap_read_one (p
, callback
, data
);
335 _w32_os_yield(); /* allow SIGINT generation, yield to Win95/NT */
341 * Return network statistics
343 static int pcap_stats_dos (pcap_t
*p
, struct pcap_stat
*ps
)
345 struct net_device_stats
*stats
;
346 struct device
*dev
= p
? get_device(p
->fd
) : NULL
;
350 strcpy (p
->errbuf
, "illegal pcap handle");
354 if (!dev
->get_stats
|| (stats
= (*dev
->get_stats
)(dev
)) == NULL
)
356 strcpy (p
->errbuf
, "device statistics not available");
362 p
->md
.stat
.ps_recv
= stats
->rx_packets
;
363 p
->md
.stat
.ps_drop
+= stats
->rx_missed_errors
;
364 p
->md
.stat
.ps_ifdrop
= stats
->rx_dropped
+ /* queue full */
365 stats
->rx_errors
; /* HW errors */
373 * Return detailed network/device statistics.
374 * May be called after 'dev->close' is called.
376 int pcap_stats_ex (pcap_t
*p
, struct pcap_stat_ex
*se
)
378 struct device
*dev
= p
? get_device (p
->fd
) : NULL
;
380 if (!dev
|| !dev
->get_stats
)
382 strlcpy (p
->errbuf
, "detailed device statistics not available",
387 if (!strnicmp(dev
->name
,"pkt",3))
389 strlcpy (p
->errbuf
, "pktdrvr doesn't have detailed statistics",
393 memcpy (se
, (*dev
->get_stats
)(dev
), sizeof(*se
));
398 * Simply store the filter-code for the pcap_read_dos() callback
399 * Some day the filter-code could be handed down to the active
400 * device (pkt_rx1.s or 32-bit device interrupt handler).
402 static int pcap_setfilter_dos (pcap_t
*p
, struct bpf_program
*fp
)
411 * Return # of packets received in pcap_read_dos()
413 u_long
pcap_mac_packets (void)
419 * Return # of packets passed through filter in pcap_read_dos()
421 u_long
pcap_filter_packets (void)
423 return (filter_count
);
427 * Close pcap device. Not called for offline captures.
429 static void pcap_cleanup_dos (pcap_t
*p
)
431 if (p
&& !exc_occured
)
433 if (pcap_stats(p
,NULL
) < 0)
434 p
->md
.stat
.ps_drop
= 0;
435 if (!get_device(p
->fd
))
438 handle_to_device
[p
->fd
-1] = NULL
;
449 * Return the name of the 1st network interface,
450 * or NULL if none can be found.
452 char *pcap_lookupdev (char *ebuf
)
456 #ifdef USE_32BIT_DRIVERS
460 for (dev
= (struct device
*)dev_base
; dev
; dev
= dev
->next
)
462 PCAP_ASSERT (dev
->probe
);
464 if ((*dev
->probe
)(dev
))
467 probed_dev
= (struct device
*) dev
; /* remember last probed device */
468 return (char*) dev
->name
;
473 strcpy (ebuf
, "No driver found");
478 * Gets localnet & netmask from Watt-32.
480 int pcap_lookupnet (const char *device
, bpf_u_int32
*localnet
,
481 bpf_u_int32
*netmask
, char *errbuf
)
485 strcpy (errbuf
, "pcap_open_offline() or pcap_activate() must be "
490 *netmask
= _w32_sin_mask
;
491 *localnet
= my_ip_addr
& *netmask
;
494 if (IN_CLASSA(*netmask
))
495 *localnet
= IN_CLASSA_NET
;
496 else if (IN_CLASSB(*netmask
))
497 *localnet
= IN_CLASSB_NET
;
498 else if (IN_CLASSC(*netmask
))
499 *localnet
= IN_CLASSC_NET
;
502 sprintf (errbuf
, "inet class for 0x%lx unknown", *netmask
);
511 * Get a list of all interfaces that are present and that we probe okay.
512 * Returns -1 on error, 0 otherwise.
513 * The list, as returned through "alldevsp", may be null if no interfaces
514 * were up and could be opened.
516 int pcap_findalldevs (pcap_if_t
**alldevsp
, char *errbuf
)
519 struct sockaddr_ll sa_ll_1
, sa_ll_2
;
520 struct sockaddr
*addr
, *netmask
, *broadaddr
, *dstaddr
;
521 pcap_if_t
*devlist
= NULL
;
523 size_t addr_size
= sizeof(struct sockaddr_ll
);
525 for (dev
= (struct device
*)dev_base
; dev
; dev
= dev
->next
)
527 PCAP_ASSERT (dev
->probe
);
529 if (!(*dev
->probe
)(dev
))
532 PCAP_ASSERT (dev
->close
); /* set by probe routine */
536 memset (&sa_ll_1
, 0, sizeof(sa_ll_1
));
537 memset (&sa_ll_2
, 0, sizeof(sa_ll_2
));
538 sa_ll_1
.sll_family
= AF_PACKET
;
539 sa_ll_2
.sll_family
= AF_PACKET
;
541 addr
= (struct sockaddr
*) &sa_ll_1
;
542 netmask
= (struct sockaddr
*) &sa_ll_1
;
543 dstaddr
= (struct sockaddr
*) &sa_ll_1
;
544 broadaddr
= (struct sockaddr
*) &sa_ll_2
;
545 memset (&sa_ll_2
.sll_addr
, 0xFF, sizeof(sa_ll_2
.sll_addr
));
547 if (pcap_add_if(&devlist
, dev
->name
, dev
->flags
,
548 dev
->long_name
, errbuf
) < 0)
553 if (add_addr_to_iflist(&devlist
,dev
->name
, dev
->flags
, addr
, addr_size
,
554 netmask
, addr_size
, broadaddr
, addr_size
,
555 dstaddr
, addr_size
, errbuf
) < 0)
562 if (devlist
&& ret
< 0)
564 pcap_freealldevs (devlist
);
569 strcpy (errbuf
, "No drivers found");
576 * pcap_assert() is mainly used for debugging
578 void pcap_assert (const char *what
, const char *file
, unsigned line
)
581 fprintf (stderr
, "%s (%u): Assertion \"%s\" failed\n",
588 * For pcap_offline_read(): wait and yield between printing packets
589 * to simulate the pace packets where actually recorded.
591 void pcap_set_wait (pcap_t
*p
, void (*yield
)(void), int wait
)
595 p
->wait_proc
= yield
;
596 p
->md
.timeout
= wait
;
601 * Initialise a named network device.
603 static struct device
*
604 open_driver (const char *dev_name
, char *ebuf
, int promisc
)
608 for (dev
= (struct device
*)dev_base
; dev
; dev
= dev
->next
)
610 PCAP_ASSERT (dev
->name
);
612 if (strcmp (dev_name
,dev
->name
))
615 if (!probed_dev
) /* user didn't call pcap_lookupdev() first */
617 PCAP_ASSERT (dev
->probe
);
619 if (!(*dev
->probe
)(dev
)) /* call the xx_probe() function */
621 sprintf (ebuf
, "failed to detect device `%s'", dev_name
);
624 probed_dev
= dev
; /* device is probed okay and may be used */
626 else if (dev
!= probed_dev
)
633 /* Select what traffic to receive
636 dev
->flags
|= (IFF_ALLMULTI
| IFF_PROMISC
);
637 else dev
->flags
&= ~(IFF_ALLMULTI
| IFF_PROMISC
);
639 PCAP_ASSERT (dev
->open
);
641 if (!(*dev
->open
)(dev
))
643 sprintf (ebuf
, "failed to activate device `%s'", dev_name
);
644 if (pktInfo
.error
&& !strncmp(dev
->name
,"pkt",3))
647 strcat (ebuf
, pktInfo
.error
);
652 /* Some devices need this to operate in promiscous mode
654 if (promisc
&& dev
->set_multicast_list
)
655 (*dev
->set_multicast_list
) (dev
);
657 active_dev
= dev
; /* remember our active device */
661 /* 'dev_name' not matched in 'dev_base' list.
665 sprintf (ebuf
, "device `%s' not supported", dev_name
);
672 sprintf (ebuf
, "device `%s' not probed", dev_name
);
679 * Deinitialise MAC driver.
680 * Set receive mode back to default mode.
682 static void close_driver (void)
684 /* !!todo: loop over all 'handle_to_device[]' ? */
685 struct device
*dev
= active_dev
;
687 if (dev
&& dev
->close
)
695 #ifdef USE_32BIT_DRIVERS
708 static void setup_signals (void (*handler
)(int))
710 signal (SIGSEGV
,handler
);
711 signal (SIGILL
, handler
);
712 signal (SIGFPE
, handler
);
715 static void exc_handler (int sig
)
717 #ifdef USE_32BIT_DRIVERS
718 if (active_dev
->irq
> 0) /* excludes IRQ 0 */
720 disable_irq (active_dev
->irq
);
721 irq_eoi_cmd (active_dev
->irq
);
729 fputs ("Catching SIGSEGV.\n", stderr
);
732 fputs ("Catching SIGILL.\n", stderr
);
736 fputs ("Catching SIGFPE.\n", stderr
);
739 fprintf (stderr
, "Catching signal %d.\n", sig
);
742 pcap_cleanup_dos (NULL
);
744 #endif /* __DJGPP__ */
748 * Open the pcap device for the first client calling pcap_activate()
750 static int first_init (const char *name
, char *ebuf
, int promisc
)
754 #ifdef USE_32BIT_DRIVERS
755 rx_pool
= k_calloc (RECEIVE_BUF_SIZE
, RECEIVE_QUEUE_SIZE
);
758 strcpy (ebuf
, "Not enough memory (Rx pool)");
764 setup_signals (exc_handler
);
767 #ifdef USE_32BIT_DRIVERS
771 dev
= open_driver (name
, ebuf
, promisc
);
774 #ifdef USE_32BIT_DRIVERS
780 setup_signals (SIG_DFL
);
785 #ifdef USE_32BIT_DRIVERS
787 * If driver is NOT a 16-bit "pkt/ndis" driver (having a 'copy_rx_buf'
788 * set in it's probe handler), initialise near-memory ring-buffer for
791 if (dev
->copy_rx_buf
== NULL
)
793 dev
->get_rx_buf
= get_rxbuf
;
794 dev
->peek_rx_buf
= peek_rxbuf
;
795 dev
->release_rx_buf
= release_rxbuf
;
796 pktq_init (&dev
->queue
, RECEIVE_BUF_SIZE
, RECEIVE_QUEUE_SIZE
, rx_pool
);
802 #ifdef USE_32BIT_DRIVERS
803 static void init_32bit (void)
805 static int init_pci
= 0;
808 _printk_init (64*1024, NULL
); /* calls atexit(printk_exit) */
811 (void)pci_init(); /* init BIOS32+PCI interface */
818 * Hook functions for using Watt-32 together with pcap
820 static char rxbuf
[ETH_MAX
+100]; /* rx-buffer with some margin */
822 static pcap_t pcap_save
;
824 static void watt32_recv_hook (u_char
*dummy
, const struct pcap_pkthdr
*pcap
,
827 /* Fix me: assumes Ethernet II only */
828 struct ether_header
*ep
= (struct ether_header
*) buf
;
830 memcpy (rxbuf
, buf
, pcap
->caplen
);
831 etype
= ep
->ether_type
;
835 #if (WATTCP_VER >= 0x0224)
837 * This function is used by Watt-32 to poll for a packet.
838 * i.e. it's set to bypass _eth_arrived()
840 static void *pcap_recv_hook (WORD
*type
)
842 int len
= pcap_read_dos (&pcap_save
, 1, watt32_recv_hook
, NULL
);
848 return (void*) &rxbuf
;
852 * This function is called by Watt-32 (via _eth_xmit_hook).
853 * If dbug_init() was called, we should trace packets sent.
855 static int pcap_xmit_hook (const void *buf
, unsigned len
)
859 if (pcap_pkt_debug
> 0)
860 dbug_write ("pcap_xmit_hook: ");
862 if (active_dev
&& active_dev
->xmit
)
863 if ((*active_dev
->xmit
) (active_dev
, buf
, len
) > 0)
866 if (pcap_pkt_debug
> 0)
867 dbug_write (rc
? "ok\n" : "fail\n");
872 static int pcap_sendpacket_dos (pcap_t
*p
, const void *buf
, size_t len
)
874 struct device
*dev
= p
? get_device(p
->fd
) : NULL
;
876 if (!dev
|| !dev
->xmit
)
878 return (*dev
->xmit
) (dev
, buf
, len
);
882 * This function is called by Watt-32 in tcp_post_init().
883 * We should prevent Watt-32 from using BOOTP/DHCP/RARP etc.
885 static void (*prev_post_hook
) (void);
887 static void pcap_init_hook (void)
889 _w32__bootp_on
= _w32__dhcp_on
= _w32__rarp_on
= 0;
890 _w32__do_mask_req
= 0;
891 _w32_dynamic_host
= 0;
897 * Supress PRINT message from Watt-32's sock_init()
899 static void null_print (void) {}
902 * To use features of Watt-32 (netdb functions and socket etc.)
903 * we must call sock_init(). But we set various hooks to prevent
904 * using normal PKTDRVR functions in pcpkt.c. This should hopefully
905 * make Watt-32 and pcap co-operate.
907 static int init_watt32 (struct pcap
*pcap
, const char *dev_name
, char *err_buf
)
910 int rc
, MTU
, has_ip_addr
;
911 int using_pktdrv
= 1;
913 /* If user called sock_init() first, we need to reinit in
914 * order to open debug/trace-file properly
919 env
= getenv ("PCAP_DEBUG");
920 if (env
&& atoi(env
) > 0 &&
921 pcap_pkt_debug
< 0) /* if not already set */
924 pcap_pkt_debug
= atoi (env
);
927 _watt_do_exit
= 0; /* prevent sock_init() calling exit() */
928 prev_post_hook
= _w32_usr_post_init
;
929 _w32_usr_post_init
= pcap_init_hook
;
930 _w32_print_hook
= null_print
;
932 if (dev_name
&& strncmp(dev_name
,"pkt",3))
933 using_pktdrv
= FALSE
;
936 has_ip_addr
= (rc
!= 8); /* IP-address assignment failed */
938 /* if pcap is using a 32-bit driver w/o a pktdrvr loaded, we
939 * just pretend Watt-32 is initialised okay.
941 * !! fix-me: The Watt-32 config isn't done if no pktdrvr
942 * was found. In that case my_ip_addr + sin_mask
943 * have default values. Should be taken from another
944 * ini-file/environment in any case (ref. tcpdump.ini)
948 if (!using_pktdrv
|| !has_ip_addr
) /* for now .... */
950 static const char myip
[] = "192.168.0.1";
951 static const char mask
[] = "255.255.255.0";
953 printf ("Just guessing, using IP %s and netmask %s\n", myip
, mask
);
954 my_ip_addr
= aton (myip
);
955 _w32_sin_mask
= aton (mask
);
957 else if (rc
&& using_pktdrv
)
959 sprintf (err_buf
, "sock_init() failed, code %d", rc
);
963 /* Set recv-hook for peeking in _eth_arrived().
965 #if (WATTCP_VER >= 0x0224)
966 _eth_recv_hook
= pcap_recv_hook
;
967 _eth_xmit_hook
= pcap_xmit_hook
;
970 /* Free the pkt-drvr handle allocated in pkt_init().
971 * The above hooks should thus use the handle reopened in open_driver()
976 /* _eth_is_init = 1; */ /* hack to get Rx/Tx-hooks in Watt-32 working */
979 memcpy (&pcap_save
, pcap
, sizeof(pcap_save
));
981 pcap_save
.fcode
.bf_insns
= NULL
;
982 pcap_save
.linktype
= _eth_get_hwtype (NULL
, NULL
);
983 pcap_save
.snapshot
= MTU
> 0 ? MTU
: ETH_MAX
; /* assume 1514 */
986 /* prevent use of resolve() and resolve_ip()
993 int EISA_bus
= 0; /* Where is natural place for this? */
996 * Application config hooks to set various driver parameters.
999 static const struct config_table debug_tab
[] = {
1000 { "PKT.DEBUG", ARG_ATOI
, &pcap_pkt_debug
},
1001 { "PKT.VECTOR", ARG_ATOX_W
, NULL
},
1002 { "NDIS.DEBUG", ARG_ATOI
, NULL
},
1003 #ifdef USE_32BIT_DRIVERS
1004 { "3C503.DEBUG", ARG_ATOI
, &ei_debug
},
1005 { "3C503.IO_BASE", ARG_ATOX_W
, &el2_dev
.base_addr
},
1006 { "3C503.MEMORY", ARG_ATOX_W
, &el2_dev
.mem_start
},
1007 { "3C503.IRQ", ARG_ATOI
, &el2_dev
.irq
},
1008 { "3C505.DEBUG", ARG_ATOI
, NULL
},
1009 { "3C505.BASE", ARG_ATOX_W
, NULL
},
1010 { "3C507.DEBUG", ARG_ATOI
, NULL
},
1011 { "3C509.DEBUG", ARG_ATOI
, &el3_debug
},
1012 { "3C509.ILOOP", ARG_ATOI
, &el3_max_loop
},
1013 { "3C529.DEBUG", ARG_ATOI
, NULL
},
1014 { "3C575.DEBUG", ARG_ATOI
, &debug_3c575
},
1015 { "3C59X.DEBUG", ARG_ATOI
, &vortex_debug
},
1016 { "3C59X.IFACE0", ARG_ATOI
, &vortex_options
[0] },
1017 { "3C59X.IFACE1", ARG_ATOI
, &vortex_options
[1] },
1018 { "3C59X.IFACE2", ARG_ATOI
, &vortex_options
[2] },
1019 { "3C59X.IFACE3", ARG_ATOI
, &vortex_options
[3] },
1020 { "3C90X.DEBUG", ARG_ATOX_W
, &tc90xbc_debug
},
1021 { "ACCT.DEBUG", ARG_ATOI
, ðpk_debug
},
1022 { "CS89.DEBUG", ARG_ATOI
, &cs89_debug
},
1023 { "RTL8139.DEBUG", ARG_ATOI
, &rtl8139_debug
},
1024 /* { "RTL8139.FDUPLEX", ARG_ATOI, &rtl8139_options }, */
1025 { "SMC.DEBUG", ARG_ATOI
, &ei_debug
},
1026 /* { "E100.DEBUG", ARG_ATOI, &e100_debug }, */
1027 { "PCI.DEBUG", ARG_ATOI
, &pci_debug
},
1028 { "BIOS32.DEBUG", ARG_ATOI
, &bios32_debug
},
1029 { "IRQ.DEBUG", ARG_ATOI
, &irq_debug
},
1030 { "TIMER.IRQ", ARG_ATOI
, &timer_irq
},
1036 * pcap_config_hook() is an extension to application's config
1037 * handling. Uses Watt-32's config-table function.
1039 int pcap_config_hook (const char *name
, const char *value
)
1041 return parse_config_table (debug_tab
, NULL
, name
, value
);
1045 * Linked list of supported devices
1047 struct device
*active_dev
= NULL
; /* the device we have opened */
1048 struct device
*probed_dev
= NULL
; /* the device we have probed */
1049 const struct device
*dev_base
= &pkt_dev
; /* list of network devices */
1052 * PKTDRVR device functions
1054 int pcap_pkt_debug
= -1;
1056 static void pkt_close (struct device
*dev
)
1058 BOOL okay
= PktExitDriver();
1060 if (pcap_pkt_debug
> 1)
1061 fprintf (stderr
, "pkt_close(): %d\n", okay
);
1068 static int pkt_open (struct device
*dev
)
1072 if (dev
->flags
& IFF_PROMISC
)
1073 mode
= PDRX_ALL_PACKETS
;
1074 else mode
= PDRX_BROADCAST
;
1076 if (!PktInitDriver(mode
))
1079 PktResetStatistics (pktInfo
.handle
);
1080 PktQueueBusy (FALSE
);
1084 static int pkt_xmit (struct device
*dev
, const void *buf
, int len
)
1086 struct net_device_stats
*stats
= (struct net_device_stats
*) dev
->priv
;
1088 if (pcap_pkt_debug
> 0)
1089 dbug_write ("pcap_xmit\n");
1091 if (!PktTransmit(buf
,len
))
1099 static void *pkt_stats (struct device
*dev
)
1101 struct net_device_stats
*stats
= (struct net_device_stats
*) dev
->priv
;
1103 if (!stats
|| !PktSessStatistics(pktInfo
.handle
))
1106 stats
->rx_packets
= pktStat
.inPackets
;
1107 stats
->rx_errors
= pktStat
.lost
;
1108 stats
->rx_missed_errors
= PktRxDropped();
1112 static int pkt_probe (struct device
*dev
)
1114 if (!PktSearchDriver())
1117 dev
->open
= pkt_open
;
1118 dev
->xmit
= pkt_xmit
;
1119 dev
->close
= pkt_close
;
1120 dev
->get_stats
= pkt_stats
;
1121 dev
->copy_rx_buf
= PktReceive
; /* farmem peek and copy routine */
1122 dev
->get_rx_buf
= NULL
;
1123 dev
->peek_rx_buf
= NULL
;
1124 dev
->release_rx_buf
= NULL
;
1125 dev
->priv
= calloc (sizeof(struct net_device_stats
), 1);
1132 * NDIS device functions
1134 static void ndis_close (struct device
*dev
)
1142 static int ndis_open (struct device
*dev
)
1144 int promis
= (dev
->flags
& IFF_PROMISC
);
1147 if (!NdisInit(promis
))
1156 static void *ndis_stats (struct device
*dev
)
1158 static struct net_device_stats stats
;
1165 static int ndis_probe (struct device
*dev
)
1172 dev
->open
= ndis_open
;
1174 dev
->close
= ndis_close
;
1175 dev
->get_stats
= ndis_stats
;
1176 dev
->copy_rx_buf
= NULL
; /* to-do */
1177 dev
->get_rx_buf
= NULL
; /* upcall is from rmode driver */
1178 dev
->peek_rx_buf
= NULL
;
1179 dev
->release_rx_buf
= NULL
;
1184 * Search & probe for supported 32-bit (pmode) pcap devices
1186 #if defined(USE_32BIT_DRIVERS)
1188 struct device el2_dev LOCKED_VAR
= {
1197 struct device el3_dev LOCKED_VAR
= {
1206 struct device tc515_dev LOCKED_VAR
= {
1215 struct device tc59_dev LOCKED_VAR
= {
1224 struct device tc90xbc_dev LOCKED_VAR
= {
1233 struct device wd_dev LOCKED_VAR
= {
1242 struct device ne_dev LOCKED_VAR
= {
1251 struct device acct_dev LOCKED_VAR
= {
1253 "Accton EtherPocket",
1260 struct device cs89_dev LOCKED_VAR
= {
1262 "Crystal Semiconductor",
1269 struct device rtl8139_dev LOCKED_VAR
= {
1275 rtl8139_probe
/* dev->probe routine */
1279 * Dequeue routine is called by polling.
1280 * NOTE: the queue-element is not copied, only a pointer is
1281 * returned at '*buf'
1283 int peek_rxbuf (BYTE
**buf
)
1285 struct rx_elem
*tail
, *head
;
1287 PCAP_ASSERT (pktq_check (&active_dev
->queue
));
1290 tail
= pktq_out_elem (&active_dev
->queue
);
1291 head
= pktq_in_elem (&active_dev
->queue
);
1296 PCAP_ASSERT (tail
->size
< active_dev
->queue
.elem_size
-4-2);
1298 *buf
= &tail
->data
[0];
1299 return (tail
->size
);
1306 * Release buffer we peeked at above.
1308 int release_rxbuf (BYTE
*buf
)
1311 struct rx_elem
*tail
= pktq_out_elem (&active_dev
->queue
);
1313 PCAP_ASSERT (&tail
->data
[0] == buf
);
1317 pktq_inc_out (&active_dev
->queue
);
1322 * get_rxbuf() routine (in locked code) is called from IRQ handler
1323 * to request a buffer. Interrupts are disabled and we have a 32kB stack.
1325 BYTE
*get_rxbuf (int len
)
1329 if (len
< ETH_MIN
|| len
> ETH_MAX
)
1332 idx
= pktq_in_index (&active_dev
->queue
);
1336 static int fan_idx LOCKED_VAR
= 0;
1337 writew ("-\\|/"[fan_idx
++] | (15 << 8), /* white on black colour */
1338 0xB8000 + 2*79); /* upper-right corner, 80-col colour screen */
1341 /* writew (idx + '0' + 0x0F00, 0xB8000 + 2*78); */
1344 if (idx
!= active_dev
->queue
.out_index
)
1346 struct rx_elem
*head
= pktq_in_elem (&active_dev
->queue
);
1349 active_dev
->queue
.in_index
= idx
;
1350 return (&head
->data
[0]);
1353 /* !!to-do: drop 25% of the oldest element
1355 pktq_clear (&active_dev
->queue
);
1360 * Simple ring-buffer queue handler for reception of packets
1361 * from network driver.
1363 #define PKTQ_MARKER 0xDEADBEEF
1365 static int pktq_check (struct rx_ringbuf
*q
)
1372 if (!q
|| !q
->num_elem
|| !q
->buf_start
)
1378 for (i
= 0; i
< q
->num_elem
; i
++)
1380 buf
+= q
->elem_size
;
1381 if (*(DWORD
*)(buf
- sizeof(DWORD
)) != PKTQ_MARKER
)
1388 static int pktq_init (struct rx_ringbuf
*q
, int size
, int num
, char *pool
)
1392 q
->elem_size
= size
;
1394 q
->buf_start
= pool
;
1398 PCAP_ASSERT (size
>= sizeof(struct rx_elem
) + sizeof(DWORD
));
1402 for (i
= 0; i
< num
; i
++)
1405 struct rx_elem
*elem
= (struct rx_elem
*) pool
;
1407 /* assert dword aligned elements
1409 PCAP_ASSERT (((unsigned)(&elem
->data
[0]) & 3) == 0);
1412 *(DWORD
*) (pool
- sizeof(DWORD
)) = PKTQ_MARKER
;
1418 * Increment the queue 'out_index' (tail).
1421 static int pktq_inc_out (struct rx_ringbuf
*q
)
1424 if (q
->out_index
>= q
->num_elem
)
1426 return (q
->out_index
);
1430 * Return the queue's next 'in_index' (head).
1433 static int pktq_in_index (struct rx_ringbuf
*q
)
1435 volatile int index
= q
->in_index
+ 1;
1437 if (index
>= q
->num_elem
)
1443 * Return the queue's head-buffer.
1445 static struct rx_elem
*pktq_in_elem (struct rx_ringbuf
*q
)
1447 return (struct rx_elem
*) (q
->buf_start
+ (q
->elem_size
* q
->in_index
));
1451 * Return the queue's tail-buffer.
1453 static struct rx_elem
*pktq_out_elem (struct rx_ringbuf
*q
)
1455 return (struct rx_elem
*) (q
->buf_start
+ (q
->elem_size
* q
->out_index
));
1459 * Clear the queue ring-buffer by setting head=tail.
1461 static void pktq_clear (struct rx_ringbuf
*q
)
1463 q
->in_index
= q
->out_index
;
1467 * Symbols that must be linkable for "gcc -O0"
1475 #include "msdos/pm_drvr/ioport.h"
1476 #include "msdos/pm_drvr/dma.h"
1478 #endif /* USE_32BIT_DRIVERS */