| 22 |
|
|
| 23 |
|
#include <sys/ioctl.h> |
| 24 |
|
#include <sys/poll.h> |
| 25 |
+ |
#include <sys/socket.h> |
| 26 |
+ |
#include <netinet/in.h> |
| 27 |
|
#include <pthread.h> |
| 28 |
|
#include <semaphore.h> |
| 29 |
|
#include <errno.h> |
| 30 |
|
#include <stdio.h> |
| 31 |
< |
|
| 30 |
< |
#include <netinet/in.h> |
| 31 |
< |
#include <sys/socket.h> |
| 31 |
> |
#include <map> |
| 32 |
|
|
| 33 |
|
#if defined(__FreeBSD__) |
| 34 |
|
#include <net/if.h> |
| 42 |
|
#include "ether.h" |
| 43 |
|
#include "ether_defs.h" |
| 44 |
|
|
| 45 |
+ |
#ifndef NO_STD_NAMESPACE |
| 46 |
+ |
using std::map; |
| 47 |
+ |
#endif |
| 48 |
+ |
|
| 49 |
|
#define DEBUG 0 |
| 50 |
|
#include "debug.h" |
| 51 |
|
|
| 52 |
|
#define MONITOR 0 |
| 53 |
|
|
| 54 |
|
|
| 51 |
– |
// List of attached protocols |
| 52 |
– |
struct NetProtocol { |
| 53 |
– |
NetProtocol *next; |
| 54 |
– |
uint16 type; |
| 55 |
– |
uint32 handler; |
| 56 |
– |
}; |
| 57 |
– |
|
| 58 |
– |
static NetProtocol *prot_list = NULL; |
| 59 |
– |
|
| 60 |
– |
|
| 55 |
|
// Global variables |
| 56 |
|
static int fd = -1; // fd of sheep_net device |
| 57 |
|
static pthread_t ether_thread; // Packet reception thread |
| 61 |
|
static bool is_ethertap; // Flag: Ethernet device is ethertap |
| 62 |
|
static bool udp_tunnel; // Flag: UDP tunnelling active, fd is the socket descriptor |
| 63 |
|
|
| 64 |
+ |
// Attached network protocols, maps protocol type to MacOS handler address |
| 65 |
+ |
static map<uint16, uint32> net_protocols; |
| 66 |
+ |
|
| 67 |
|
// Prototypes |
| 68 |
|
static void *receive_func(void *arg); |
| 69 |
|
|
| 70 |
|
|
| 71 |
|
/* |
| 75 |
– |
* Find protocol in list |
| 76 |
– |
*/ |
| 77 |
– |
|
| 78 |
– |
static NetProtocol *find_protocol(uint16 type) |
| 79 |
– |
{ |
| 80 |
– |
// All 802.2 types are the same |
| 81 |
– |
if (type <= 1500) |
| 82 |
– |
type = 0; |
| 83 |
– |
|
| 84 |
– |
// Search list (we could use hashing here but there are usually only three |
| 85 |
– |
// handlers installed: 0x0000 for AppleTalk and 0x0800/0x0806 for TCP/IP) |
| 86 |
– |
NetProtocol *p = prot_list; |
| 87 |
– |
while (p) { |
| 88 |
– |
if (p->type == type) |
| 89 |
– |
return p; |
| 90 |
– |
p = p->next; |
| 91 |
– |
} |
| 92 |
– |
return NULL; |
| 93 |
– |
} |
| 94 |
– |
|
| 95 |
– |
|
| 96 |
– |
/* |
| 97 |
– |
* Remove all protocols |
| 98 |
– |
*/ |
| 99 |
– |
|
| 100 |
– |
static void remove_all_protocols(void) |
| 101 |
– |
{ |
| 102 |
– |
NetProtocol *p = prot_list; |
| 103 |
– |
while (p) { |
| 104 |
– |
NetProtocol *next = p->next; |
| 105 |
– |
delete p; |
| 106 |
– |
p = next; |
| 107 |
– |
} |
| 108 |
– |
prot_list = NULL; |
| 109 |
– |
} |
| 110 |
– |
|
| 111 |
– |
|
| 112 |
– |
/* |
| 72 |
|
* Start packet reception thread |
| 73 |
|
*/ |
| 74 |
|
|
| 205 |
|
// Close sheep_net device |
| 206 |
|
if (fd > 0) |
| 207 |
|
close(fd); |
| 249 |
– |
|
| 250 |
– |
// Remove all protocols |
| 251 |
– |
remove_all_protocols(); |
| 208 |
|
} |
| 209 |
|
|
| 210 |
|
|
| 212 |
|
* Reset |
| 213 |
|
*/ |
| 214 |
|
|
| 215 |
< |
void EtherReset(void) |
| 215 |
> |
void ether_reset(void) |
| 216 |
|
{ |
| 217 |
< |
remove_all_protocols(); |
| 217 |
> |
net_protocols.clear(); |
| 218 |
|
} |
| 219 |
|
|
| 220 |
|
|
| 255 |
|
|
| 256 |
|
int16 ether_attach_ph(uint16 type, uint32 handler) |
| 257 |
|
{ |
| 258 |
< |
// Already attached? |
| 303 |
< |
NetProtocol *p = find_protocol(type); |
| 304 |
< |
if (p != NULL) |
| 258 |
> |
if (net_protocols.find(type) != net_protocols.end()) |
| 259 |
|
return lapProtErr; |
| 260 |
< |
else { |
| 261 |
< |
// No, create and attach |
| 308 |
< |
p = new NetProtocol; |
| 309 |
< |
p->next = prot_list; |
| 310 |
< |
p->type = type; |
| 311 |
< |
p->handler = handler; |
| 312 |
< |
prot_list = p; |
| 313 |
< |
return noErr; |
| 314 |
< |
} |
| 260 |
> |
net_protocols[type] = handler; |
| 261 |
> |
return noErr; |
| 262 |
|
} |
| 263 |
|
|
| 264 |
|
|
| 268 |
|
|
| 269 |
|
int16 ether_detach_ph(uint16 type) |
| 270 |
|
{ |
| 271 |
< |
NetProtocol *p = find_protocol(type); |
| 325 |
< |
if (p != NULL) { |
| 326 |
< |
NetProtocol *q = prot_list; |
| 327 |
< |
if (p == q) { |
| 328 |
< |
prot_list = p->next; |
| 329 |
< |
delete p; |
| 330 |
< |
return noErr; |
| 331 |
< |
} |
| 332 |
< |
while (q) { |
| 333 |
< |
if (q->next == p) { |
| 334 |
< |
q->next = p->next; |
| 335 |
< |
delete p; |
| 336 |
< |
return noErr; |
| 337 |
< |
} |
| 338 |
< |
q = q->next; |
| 339 |
< |
} |
| 340 |
< |
return lapProtErr; |
| 341 |
< |
} else |
| 271 |
> |
if (net_protocols.erase(type) == 0) |
| 272 |
|
return lapProtErr; |
| 273 |
+ |
return noErr; |
| 274 |
|
} |
| 275 |
|
|
| 276 |
|
|
| 417 |
|
uint16 type = (p[12] << 8) | p[13]; |
| 418 |
|
|
| 419 |
|
// Look for protocol |
| 420 |
< |
NetProtocol *prot = find_protocol(type); |
| 421 |
< |
if (prot == NULL) |
| 420 |
> |
uint16 search_type = (type <= 1500 ? 0 : type); |
| 421 |
> |
if (net_protocols.find(search_type) == net_protocols.end()) |
| 422 |
|
continue; |
| 423 |
+ |
uint32 handler = net_protocols[search_type]; |
| 424 |
|
|
| 425 |
|
// No default handler |
| 426 |
< |
if (prot->handler == 0) |
| 426 |
> |
if (handler == 0) |
| 427 |
|
continue; |
| 428 |
|
|
| 429 |
|
// Copy header to RHA |
| 437 |
|
r.a[0] = (uint32)p + 14; // Pointer to packet (host address, for ReadPacket) |
| 438 |
|
r.a[3] = ether_data + ed_RHA + 14; // Pointer behind header in RHA |
| 439 |
|
r.a[4] = ether_data + ed_ReadPacket; // Pointer to ReadPacket/ReadRest routines |
| 440 |
< |
D(bug(" calling protocol handler %08x, type %08x, length %08x, data %08x, rha %08x, read_packet %08x\n", prot->handler, r.d[0], r.d[1], r.a[0], r.a[3], r.a[4])); |
| 441 |
< |
Execute68k(prot->handler, &r); |
| 440 |
> |
D(bug(" calling protocol handler %08x, type %08x, length %08x, data %08x, rha %08x, read_packet %08x\n", handler, r.d[0], r.d[1], r.a[0], r.a[3], r.a[4])); |
| 441 |
> |
Execute68k(handler, &r); |
| 442 |
|
} |
| 443 |
|
} |
| 444 |
|
|
