ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/BasiliskII/src/BeOS/ether_beos.cpp
(Generate patch)

Comparing BasiliskII/src/BeOS/ether_beos.cpp (file contents):
Revision 1.7 by cebix, 2001-07-13T15:39:22Z vs.
Revision 1.13 by gbeauche, 2005-03-19T17:43:03Z

# Line 1 | Line 1
1   /*
2   *  ether_beos.cpp - Ethernet device driver, BeOS specific stuff
3   *
4 < *  Basilisk II (C) 1997-2001 Christian Bauer
5 < *  Portions (C) 1997-1999 Marc Hellwig
4 > *  Basilisk II (C) 1997-2005 Christian Bauer
5 > *  Portions written by Marc Hellwig
6   *
7   *  This program is free software; you can redistribute it and/or modify
8   *  it under the terms of the GNU General Public License as published by
# Line 19 | Line 19
19   *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20   */
21  
22 + #include "sysdeps.h"
23 +
24   #include <KernelKit.h>
25   #include <AppKit.h>
26   #include <StorageKit.h>
# Line 27 | Line 29
29   #include <stdio.h>
30   #include <stdlib.h>
31   #include <string.h>
32 + #include <sys/socket.h>
33  
31 – #include "sysdeps.h"
34   #include "cpu_emulation.h"
35   #include "main.h"
36   #include "prefs.h"
# Line 64 | Line 66 | static uint32 rd_pos;                                          // Current re
66   static uint32 wr_pos;                                           // Current write position in packet buffer
67   static sem_id read_sem, write_sem;                      // Semaphores to trigger packet reading/writing
68  
69 + static int fd = -1;                                                     // UDP socket fd
70 + static bool udp_tunnel = false;
71 +
72  
73   // Prototypes
74   static status_t receive_proc(void *data);
# Line 363 | Line 368 | int16 ether_write(uint32 wds)
368                  // Copy packet to buffer
369                  int len = ether_wds_to_buffer(wds, p->data);
370  
366 –                // Set source address
367 –                memcpy(p->data + 6, ether_addr, 6);
368 –
371   #if MONITOR
372                  bug("Sending Ethernet packet:\n");
373                  for (int i=0; i<len; i++) {
# Line 385 | Line 387 | int16 ether_write(uint32 wds)
387  
388  
389   /*
390 < *  Packet reception thread
390 > *  Packet reception thread (non-UDP)
391   */
392  
393   static status_t receive_proc(void *data)
# Line 403 | Line 405 | static status_t receive_proc(void *data)
405  
406  
407   /*
408 + *  Packet reception thread (UDP)
409 + */
410 +
411 + static status_t receive_proc_udp(void *data)
412 + {
413 +        while (ether_thread_active) {
414 +                fd_set readfds;
415 +                FD_ZERO(&readfds);
416 +                FD_SET(fd, &readfds);
417 +                struct timeval timeout;
418 +                timeout.tv_sec = 1;
419 +                timeout.tv_usec = 0;
420 +                if (select(fd+1, &readfds, NULL, NULL, &timeout) > 0) {
421 +                        D(bug(" packet received, triggering Ethernet interrupt\n"));
422 +                        SetInterruptFlag(INTFLAG_ETHER);
423 +                        TriggerInterrupt();
424 +                }
425 +        }
426 +        return 0;
427 + }
428 +
429 +
430 + /*
431 + *  Start UDP packet reception thread
432 + */
433 +
434 + bool ether_start_udp_thread(int socket_fd)
435 + {
436 +        fd = socket_fd;
437 +        udp_tunnel = true;
438 +        ether_thread_active = true;
439 +        read_thread = spawn_thread(receive_proc_udp, "UDP Receiver", B_URGENT_DISPLAY_PRIORITY, NULL);
440 +        resume_thread(read_thread);
441 +        return true;
442 + }
443 +
444 +
445 + /*
446 + *  Stop UDP packet reception thread
447 + */
448 +
449 + void ether_stop_udp_thread(void)
450 + {
451 +        ether_thread_active = false;
452 +        status_t result;
453 +        wait_for_thread(read_thread, &result);
454 + }
455 +
456 +
457 + /*
458   *  Ethernet interrupt - activate deferred tasks to call IODone or protocol handlers
459   */
460  
461   void EtherInterrupt(void)
462   {
463          D(bug("EtherIRQ\n"));
464 +        EthernetPacket ether_packet;
465 +        uint32 packet = ether_packet.addr();
466 +
467 +        if (udp_tunnel) {
468 +
469 +                ssize_t length;
470 +
471 +                // Read packets from socket and hand to ether_udp_read() for processing
472 +                while (true) {
473 +                        struct sockaddr_in from;
474 +                        socklen_t from_len = sizeof(from);
475 +                        length = recvfrom(fd, Mac2HostAddr(packet), 1514, 0, (struct sockaddr *)&from, &from_len);
476 +                        if (length < 14)
477 +                                break;
478 +                        ether_udp_read(packet, length, &from);
479 +                }
480  
481 <        // Call protocol handler for received packets
482 <        net_packet *p = &net_buffer_ptr->read[rd_pos];
483 <        while (p->cmd & IN_USE) {
484 <                if ((p->cmd >> 8) == SHEEP_PACKET) {
481 >        } else {
482 >
483 >                // Call protocol handler for received packets
484 >                net_packet *p = &net_buffer_ptr->read[rd_pos];
485 >                while (p->cmd & IN_USE) {
486 >                        if ((p->cmd >> 8) == SHEEP_PACKET) {
487 >                                Host2Mac_memcpy(packet, p->data, p->length);
488   #if MONITOR
489 <                        bug("Receiving Ethernet packet:\n");
490 <                        for (int i=0; i<p->length; i++) {
491 <                                bug("%02x ", p->data[i]);
492 <                        }
493 <                        bug("\n");
489 >                                bug("Receiving Ethernet packet:\n");
490 >                                for (int i=0; i<p->length; i++) {
491 >                                        bug("%02x ", ReadMacInt8(packet + i));
492 >                                }
493 >                                bug("\n");
494   #endif
495 <                        // Get packet type
496 <                        uint16 type = ntohs(*(uint16 *)(p->data + 12));
495 >                                // Get packet type
496 >                                uint16 type = ReadMacInt16(packet + 12);
497  
498 <                        // Look for protocol
499 <                        NetProtocol *prot = find_protocol(type);
500 <                        if (prot == NULL)
501 <                                goto next;
502 <
503 <                        // No default handler
504 <                        if (prot->handler == 0)
505 <                                goto next;
506 <
507 <                        // Copy header to RHA
508 <                        Host2Mac_memcpy(ether_data + ed_RHA, p->data, 14);
509 <                        D(bug(" header %08lx%04lx %08lx%04lx %04lx\n", ReadMacInt32(ether_data + ed_RHA), ReadMacInt16(ether_data + ed_RHA + 4), ReadMacInt32(ether_data + ed_RHA + 6), ReadMacInt16(ether_data + ed_RHA + 10), ReadMacInt16(ether_data + ed_RHA + 12)));
510 <
511 <                        // Call protocol handler
512 <                        M68kRegisters r;
513 <                        r.d[0] = type;                                                                  // Packet type
514 <                        r.d[1] = p->length - 14;                                                // Remaining packet length (without header, for ReadPacket)
515 <                        r.a[0] = (uint32)p->data + 14;                                  // Pointer to packet (host address, for ReadPacket)
516 <                        r.a[3] = ether_data + ed_RHA + 14;                              // Pointer behind header in RHA
517 <                        r.a[4] = ether_data + ed_ReadPacket;                    // Pointer to ReadPacket/ReadRest routines
518 <                        D(bug(" calling protocol handler %08lx, type %08lx, length %08lx, data %08lx, rha %08lx, read_packet %08lx\n", prot->handler, r.d[0], r.d[1], r.a[0], r.a[3], r.a[4]));
519 <                        Execute68k(prot->handler, &r);
498 >                                // Look for protocol
499 >                                NetProtocol *prot = find_protocol(type);
500 >                                if (prot == NULL)
501 >                                        goto next;
502 >
503 >                                // No default handler
504 >                                if (prot->handler == 0)
505 >                                        goto next;
506 >
507 >                                // Copy header to RHA
508 >                                Mac2Mac_memcpy(ether_data + ed_RHA, packet, 14);
509 >                                D(bug(" header %08lx%04lx %08lx%04lx %04lx\n", ReadMacInt32(ether_data + ed_RHA), ReadMacInt16(ether_data + ed_RHA + 4), ReadMacInt32(ether_data + ed_RHA + 6), ReadMacInt16(ether_data + ed_RHA + 10), ReadMacInt16(ether_data + ed_RHA + 12)));
510 >
511 >                                // Call protocol handler
512 >                                M68kRegisters r;
513 >                                r.d[0] = type;                                                                  // Packet type
514 >                                r.d[1] = p->length - 14;                                                // Remaining packet length (without header, for ReadPacket)
515 >                                r.a[0] = packet + 14;                                                   // Pointer to packet (Mac address, for ReadPacket)
516 >                                r.a[3] = ether_data + ed_RHA + 14;                              // Pointer behind header in RHA
517 >                                r.a[4] = ether_data + ed_ReadPacket;                    // Pointer to ReadPacket/ReadRest routines
518 >                                D(bug(" calling protocol handler %08lx, type %08lx, length %08lx, data %08lx, rha %08lx, read_packet %08lx\n", prot->handler, r.d[0], r.d[1], r.a[0], r.a[3], r.a[4]));
519 >                                Execute68k(prot->handler, &r);
520 >                        }
521 > next:           p->cmd = 0;     // Free packet
522 >                        rd_pos = (rd_pos + 1) % READ_PACKET_COUNT;
523 >                        p = &net_buffer_ptr->read[rd_pos];
524                  }
450 – next:   p->cmd = 0;     // Free packet
451 –                rd_pos = (rd_pos + 1) % READ_PACKET_COUNT;
452 –                p = &net_buffer_ptr->read[rd_pos];
525          }
526          D(bug(" EtherIRQ done\n"));
527   }

Diff Legend

– Removed lines
+ Added lines
< Changed lines
> Changed lines