1
/////////////////////////////////////////////////////////////////////////
2
// $Id: eth_vde.cc 157 2007-05-15 01:17:25Z shammash $
3
/////////////////////////////////////////////////////////////////////////
5
// Copyright (C) 2003 Renzo Davoli
7
// This library is free software; you can redistribute it and/or
8
// modify it under the terms of the GNU Lesser General Public
9
// License as published by the Free Software Foundation; either
10
// version 2 of the License, or (at your option) any later version.
12
// This library is distributed in the hope that it will be useful,
13
// but WITHOUT ANY WARRANTY; without even the implied warranty of
14
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15
// Lesser General Public License for more details.
17
// You should have received a copy of the GNU Lesser General Public
18
// License along with this library; if not, write to the Free Software
19
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
21
// eth_vde.cc - Virtual Distributed Ethernet interface by Renzo Davoli <renzo@cs.unibo.it>
24
// Define BX_PLUGGABLE in files that can be compiled into plugins. For
25
// platforms that require a special tag on exported symbols, BX_PLUGGABLE
26
// is used to know when we are exporting symbols and when we are importing.
32
#define LOG_THIS bx_devices.pluginNE2kDevice->
35
#include <sys/param.h>
36
#include <sys/ioctl.h>
39
#include <sys/resource.h>
40
#include <asm/types.h>
41
#include <sys/socket.h>
45
#include <linux/netlink.h>
55
#define SWITCH_MAGIC 0xfeedface
57
//#define VDE_VIRTUAL_HW_ADDR 0xDEADBEEF
58
#define BX_ETH_VDE_LOGGING 0
59
#define BX_PACKET_BUFSIZ 2048 // Enough for an ether frame
61
int vde_alloc(char *dev,int *fdp,struct sockaddr_un *pdataout);
64
// Define the class. This is private to this module
66
class bx_vde_pktmover_c : public eth_pktmover_c {
68
bx_vde_pktmover_c(const char *netif, const char *macaddr,
71
void sendpkt(void *buf, unsigned io_len);
75
static void rx_timer_handler(void *);
77
FILE *txlog, *txlog_txt, *rxlog, *rxlog_txt;
79
struct sockaddr_un dataout;
84
// Define the static class that registers the derived pktmover class,
85
// and allocates one on request.
87
class bx_vde_locator_c : public eth_locator_c {
89
bx_vde_locator_c(void) : eth_locator_c("vde") {}
91
eth_pktmover_c *allocate(const char *netif, const char *macaddr,
94
return (new bx_vde_pktmover_c(netif, macaddr, rxh, rxarg));
100
// Define the methods for the bx_vde_pktmover derived class
104
bx_vde_pktmover_c::bx_vde_pktmover_c(const char *netif,
106
eth_rx_handler_t rxh,
110
//if (strncmp (netif, "vde", 3) != 0) {
111
// BX_PANIC (("eth_vde: interface name (%s) must be vde", netif));
113
char intname[IFNAMSIZ];
114
if (netif == NULL || strcmp(netif,"") == 0)
115
strcpy(intname,"/tmp/vde.ctl");
117
strcpy(intname,netif);
118
fd=vde_alloc(intname,&fddata,&dataout);
120
BX_PANIC (("open failed on %s: %s", netif, strerror (errno)));
124
/* set O_ASYNC flag so that we can poll with read() */
125
if ((flags = fcntl( fd, F_GETFL)) < 0) {
126
BX_PANIC (("getflags on vde device: %s", strerror (errno)));
129
if (fcntl( fd, F_SETFL, flags ) < 0) {
130
BX_PANIC (("set vde device flags: %s", strerror (errno)));
133
BX_INFO (("eth_vde: opened %s device", netif));
135
/* Execute the configuration script */
136
char *scriptname=bx_options.ne2k.Oscript->getptr();
137
if((scriptname != NULL)
138
&&(strcmp(scriptname, "") != 0)
139
&&(strcmp(scriptname, "none") != 0)) {
140
if (execute_script(scriptname, intname) < 0)
141
BX_ERROR (("execute script '%s' on %s failed", scriptname, intname));
145
this->rx_timer_index =
146
bx_pc_system.register_timer(this, this->rx_timer_handler, 1000,
147
1, 1, "eth_vde"); // continuous, active
150
#if BX_ETH_VDE_LOGGING
151
// eventually Bryce wants txlog to dump in pcap format so that
152
// tcpdump -r FILE can read it and interpret packets.
153
txlog = fopen ("ne2k-tx.log", "wb");
154
if (!txlog) BX_PANIC (("open ne2k-tx.log failed"));
155
txlog_txt = fopen ("ne2k-txdump.txt", "wb");
156
if (!txlog_txt) BX_PANIC (("open ne2k-txdump.txt failed"));
157
fprintf (txlog_txt, "vde packetmover readable log file\n");
158
fprintf (txlog_txt, "net IF = %s\n", netif);
159
fprintf (txlog_txt, "MAC address = ");
160
for (int i=0; i<6; i++)
161
fprintf (txlog_txt, "%02x%s", 0xff & macaddr[i], i<5?":" : "");
162
fprintf (txlog_txt, "\n--\n");
165
rxlog = fopen ("ne2k-rx.log", "wb");
166
if (!rxlog) BX_PANIC (("open ne2k-rx.log failed"));
167
rxlog_txt = fopen ("ne2k-rxdump.txt", "wb");
168
if (!rxlog_txt) BX_PANIC (("open ne2k-rxdump.txt failed"));
169
fprintf (rxlog_txt, "vde packetmover readable log file\n");
170
fprintf (rxlog_txt, "net IF = %s\n", netif);
171
fprintf (rxlog_txt, "MAC address = ");
172
for (int i=0; i<6; i++)
173
fprintf (rxlog_txt, "%02x%s", 0xff & macaddr[i], i<5?":" : "");
174
fprintf (rxlog_txt, "\n--\n");
181
bx_vde_pktmover_c::sendpkt(void *buf, unsigned io_len)
184
//size = write (fd, buf, io_len);
185
//size=send(fd,buf,io_len,0);
186
size=sendto(fddata,buf,io_len,0,(struct sockaddr *) &dataout, sizeof(struct sockaddr_un));
187
if (size != io_len) {
188
BX_PANIC (("write on vde device: %s", strerror (errno)));
190
BX_INFO (("wrote %d bytes on vde", io_len));
192
#if BX_ETH_VDE_LOGGING
193
BX_DEBUG (("sendpkt length %u", io_len));
194
// dump raw bytes to a file, eventually dump in pcap format so that
195
// tcpdump -r FILE can interpret them for us.
196
int n = fwrite (buf, io_len, 1, txlog);
197
if (n != 1) BX_ERROR (("fwrite to txlog failed", io_len));
198
// dump packet in hex into an ascii log file
199
fprintf (txlog_txt, "NE2K transmitting a packet, length %u\n", io_len);
200
Bit8u *charbuf = (Bit8u *)buf;
201
for (n=0; n<io_len; n++) {
202
if (((n % 16) == 0) && n>0)
203
fprintf (txlog_txt, "\n");
204
fprintf (txlog_txt, "%02x ", charbuf[n]);
206
fprintf (txlog_txt, "\n--\n");
207
// flush log so that we see the packets as they arrive w/o buffering
213
void bx_vde_pktmover_c::rx_timer_handler (void *this_ptr)
215
bx_vde_pktmover_c *class_ptr = (bx_vde_pktmover_c *) this_ptr;
216
class_ptr->rx_timer();
219
void bx_vde_pktmover_c::rx_timer ()
222
Bit8u buf[BX_PACKET_BUFSIZ];
224
struct sockaddr_un datain;
225
socklen_t datainsize;
227
datainsize=sizeof(datain);
229
//nbytes = read (fd, buf, sizeof(buf));
230
nbytes=recvfrom(fddata,buf,sizeof(buf),MSG_DONTWAIT|MSG_WAITALL,(struct sockaddr *) &datain, &datainsize);
234
// hack: TUN/TAP device likes to create an ethernet header which has
235
// the same source and destination address FE:FD:00:00:00:00.
236
// Change the dest address to FE:FD:00:00:00:01.
240
BX_INFO (("vde read returned %d bytes", nbytes));
243
BX_ERROR (("vde read error: %s", strerror(errno)));
246
#if BX_ETH_VDE_LOGGING
248
BX_DEBUG (("receive packet length %u", nbytes));
249
// dump raw bytes to a file, eventually dump in pcap format so that
250
// tcpdump -r FILE can interpret them for us.
251
int n = fwrite (rxbuf, nbytes, 1, rxlog);
252
if (n != 1) BX_ERROR (("fwrite to rxlog failed", nbytes));
253
// dump packet in hex into an ascii log file
254
fprintf (rxlog_txt, "NE2K received a packet, length %u\n", nbytes);
255
for (n=0; n<nbytes; n++) {
256
if (((n % 16) == 0) && n>0)
257
fprintf (rxlog_txt, "\n");
258
fprintf (rxlog_txt, "%02x ", rxbuf[n]);
260
fprintf (rxlog_txt, "\n--\n");
261
// flush log so that we see the packets as they arrive w/o buffering
266
BX_DEBUG(("eth_vde: got packet: %d bytes, dst=%x:%x:%x:%x:%x:%x, src=%x:%x:%x:%x:%x:%x\n", nbytes, rxbuf[0], rxbuf[1], rxbuf[2], rxbuf[3], rxbuf[4], rxbuf[5], rxbuf[6], rxbuf[7], rxbuf[8], rxbuf[9], rxbuf[10], rxbuf[11]));
268
BX_INFO (("packet too short (%d), padding to 60", nbytes));
271
(*rxh)(rxarg, rxbuf, nbytes);
274
//enum request_type { REQ_NEW_CONTROL };
275
#define REQ_NEW_CONTROL 0
280
//enum request_type type;
282
struct sockaddr_un sock;
285
static int send_fd(char *name, int fddata, struct sockaddr_un *datasock, int group)
288
struct request_v3 req;
290
struct sockaddr_un sock;
291
if((fdctl = socket(AF_UNIX, SOCK_STREAM, 0)) < 0){
295
sock.sun_family = AF_UNIX;
296
snprintf(sock.sun_path, sizeof(sock.sun_path), "%s", name);
297
if(connect(fdctl, (struct sockaddr *) &sock, sizeof(sock))){
301
req.magic=SWITCH_MAGIC;
303
req.type=((int)REQ_NEW_CONTROL)+((group > 0)?((geteuid()<<8) + group) << 8:0);
304
req.sock.sun_family=AF_UNIX;
305
memset(req.sock.sun_path, 0, sizeof(req.sock.sun_path));
306
sprintf(&req.sock.sun_path[1], "%5d", pid);
307
if(bind(fddata, (struct sockaddr *) &req.sock, sizeof(req.sock)) < 0){
311
if (send(fdctl,&req,sizeof(req),0) < 0) {
315
if (recv(fdctl,datasock,sizeof(struct sockaddr_un),0)<0) {
322
int vde_alloc(char *dev, int *fdp, struct sockaddr_un *pdataout)
328
if((fddata = socket(AF_UNIX, SOCK_DGRAM, 0)) < 0){
333
if( (fd = send_fd(dev, fddata, pdataout, 0)) < 0 )
336
//memset(&ifr, 0, sizeof(ifr));
342
#endif /* if BX_NE2K_SUPPORT */