509 lines
14 KiB
Go
509 lines
14 KiB
Go
/*
|
|
Copyright 2024 Josh Deprez
|
|
|
|
Licensed under the Apache License, Version 2.0 (the "License");
|
|
you may not use this file except in compliance with the License.
|
|
You may obtain a copy of the License at
|
|
|
|
http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
Unless required by applicable law or agreed to in writing, software
|
|
distributed under the License is distributed on an "AS IS" BASIS,
|
|
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
See the License for the specific language governing permissions and
|
|
limitations under the License.
|
|
*/
|
|
|
|
package main
|
|
|
|
import (
|
|
"bufio"
|
|
"context"
|
|
"errors"
|
|
"flag"
|
|
"fmt"
|
|
"io"
|
|
"log"
|
|
"math/rand/v2"
|
|
"net"
|
|
"net/http"
|
|
"os"
|
|
"os/signal"
|
|
"regexp"
|
|
"strings"
|
|
"sync"
|
|
|
|
"gitea.drjosh.dev/josh/jrouter/aurp"
|
|
"gitea.drjosh.dev/josh/jrouter/router"
|
|
|
|
"github.com/google/gopacket/pcap"
|
|
"github.com/sfiera/multitalk/pkg/ddp"
|
|
"github.com/sfiera/multitalk/pkg/ethernet"
|
|
"github.com/sfiera/multitalk/pkg/ethertalk"
|
|
)
|
|
|
|
var hasPortRE = regexp.MustCompile(`:\d+$`)
|
|
|
|
var configFilePath = flag.String("config", "jrouter.yaml", "Path to configuration file to use")
|
|
|
|
func main() {
|
|
flag.Parse()
|
|
log.Println("jrouter")
|
|
|
|
cfg, err := router.LoadConfig(*configFilePath)
|
|
if err != nil {
|
|
log.Fatalf("Couldn't load configuration file: %v", err)
|
|
}
|
|
|
|
localIP := net.ParseIP(cfg.LocalIP).To4()
|
|
if localIP == nil {
|
|
iaddrs, err := net.InterfaceAddrs()
|
|
if err != nil {
|
|
log.Fatalf("Couldn't read network interface addresses: %v", err)
|
|
}
|
|
for _, iaddr := range iaddrs {
|
|
inet, ok := iaddr.(*net.IPNet)
|
|
if !ok {
|
|
continue
|
|
}
|
|
if !inet.IP.IsGlobalUnicast() {
|
|
continue
|
|
}
|
|
localIP = inet.IP.To4()
|
|
if localIP != nil {
|
|
break
|
|
}
|
|
}
|
|
if localIP == nil {
|
|
log.Fatalf("No global unicast IPv4 addresses on any network interfaces, and no valid local_ip address in configuration")
|
|
}
|
|
}
|
|
localDI := aurp.IPDomainIdentifier(localIP)
|
|
|
|
log.Printf("Using %v as local domain identifier", localIP)
|
|
|
|
log.Printf("EtherTalk configuration: %+v", cfg.EtherTalk)
|
|
|
|
peers := make(map[udpAddr]*router.Peer)
|
|
var nextConnID uint16
|
|
for nextConnID == 0 {
|
|
nextConnID = uint16(rand.IntN(0x10000))
|
|
}
|
|
|
|
ln, err := net.ListenUDP("udp4", &net.UDPAddr{Port: int(cfg.ListenPort)})
|
|
if err != nil {
|
|
log.Fatalf("Couldn't listen on udp4:387: %v", err)
|
|
}
|
|
log.Printf("Listening on %v", ln.LocalAddr())
|
|
|
|
log.Println("Press ^C or send SIGINT to stop the router gracefully")
|
|
cctx, cancel := context.WithCancel(context.Background())
|
|
defer cancel()
|
|
ctx, _ := signal.NotifyContext(cctx, os.Interrupt)
|
|
|
|
// Open PCAP session
|
|
// First check the interface
|
|
iface, err := net.InterfaceByName(cfg.EtherTalk.Device)
|
|
if err != nil {
|
|
log.Fatalf("Couldn't find interface named %q: %v", cfg.EtherTalk.Device, err)
|
|
}
|
|
myHWAddr := ethernet.Addr(iface.HardwareAddr)
|
|
if cfg.EtherTalk.EthAddr != "" {
|
|
// Override myHWAddr with the configured address
|
|
netHWAddr, err := net.ParseMAC(cfg.EtherTalk.EthAddr)
|
|
if err != nil {
|
|
log.Fatalf("Couldn't parse ethertalk.ethernet_addr value %q: %v", cfg.EtherTalk.EthAddr, err)
|
|
}
|
|
myHWAddr = ethernet.Addr(netHWAddr)
|
|
}
|
|
|
|
//pcapHandle, err := pcap.OpenLive(cfg.EtherTalk.Device, 4096, true, 100*time.Millisecond)
|
|
pcapHandle, err := pcap.OpenLive(cfg.EtherTalk.Device, 4096, true, pcap.BlockForever)
|
|
if err != nil {
|
|
log.Fatalf("Couldn't open %q for packet capture: %v", cfg.EtherTalk.Device, err)
|
|
}
|
|
bpfFilter := fmt.Sprintf("(atalk or aarp) and (ether multicast or ether dst %s)", myHWAddr)
|
|
if err := pcapHandle.SetBPFFilter(bpfFilter); err != nil {
|
|
pcapHandle.Close()
|
|
log.Fatalf("Couldn't set BPF filter on packet capture: %v", err)
|
|
}
|
|
// defer pcapHandle.Close()
|
|
|
|
// Wait until all peer handlers have finished before closing the port
|
|
var handlersWG sync.WaitGroup
|
|
defer handlersWG.Wait()
|
|
// defer func() {
|
|
// // log.Print("Waiting for handlers to return...")
|
|
// // handlersWG.Wait()
|
|
// // ln.Close()
|
|
// }()
|
|
goPeerHandler := func(p *router.Peer) {
|
|
handlersWG.Add(1)
|
|
go func() {
|
|
defer handlersWG.Done()
|
|
p.Handle(ctx)
|
|
}()
|
|
}
|
|
|
|
// -------------------------------- Tables --------------------------------
|
|
routes := router.NewRoutingTable()
|
|
zones := router.NewZoneTable()
|
|
zones.Upsert(cfg.EtherTalk.NetStart, cfg.EtherTalk.ZoneName, true)
|
|
|
|
// ------------------------- Configured peer setup ------------------------
|
|
if cfg.PeerListURL != "" {
|
|
log.Printf("Fetching peer list from %s...", cfg.PeerListURL)
|
|
existing := len(cfg.Peers)
|
|
func() {
|
|
resp, err := http.Get(cfg.PeerListURL)
|
|
if err != nil {
|
|
log.Fatalf("Couldn't fetch peer list: %v", err)
|
|
}
|
|
defer resp.Body.Close()
|
|
|
|
sc := bufio.NewScanner(resp.Body)
|
|
for sc.Scan() {
|
|
p := strings.TrimSpace(sc.Text())
|
|
if p == "" {
|
|
continue
|
|
}
|
|
cfg.Peers = append(cfg.Peers, p)
|
|
}
|
|
if err := sc.Err(); err != nil {
|
|
log.Fatalf("Couldn't scan peer list response: %v", err)
|
|
}
|
|
}()
|
|
log.Printf("Fetched list containing %d peers", len(cfg.Peers)-existing)
|
|
}
|
|
|
|
for _, peerStr := range cfg.Peers {
|
|
if !hasPortRE.MatchString(peerStr) {
|
|
peerStr += ":387"
|
|
}
|
|
|
|
raddr, err := net.ResolveUDPAddr("udp4", peerStr)
|
|
if err != nil {
|
|
log.Printf("couldn't resolve UDP address, skipping: %v", err)
|
|
continue
|
|
}
|
|
log.Printf("resolved %q to %v", peerStr, raddr)
|
|
|
|
if raddr.IP.Equal(localIP) {
|
|
log.Printf("%v == %v == me, skipping", peerStr, raddr)
|
|
continue
|
|
}
|
|
|
|
peer := &router.Peer{
|
|
Config: cfg,
|
|
Transport: &aurp.Transport{
|
|
LocalDI: localDI,
|
|
RemoteDI: aurp.IPDomainIdentifier(raddr.IP),
|
|
LocalConnID: nextConnID,
|
|
},
|
|
UDPConn: ln,
|
|
RemoteAddr: raddr,
|
|
RecieveCh: make(chan aurp.Packet, 1024),
|
|
RoutingTable: routes,
|
|
ZoneTable: zones,
|
|
Reconnect: true,
|
|
}
|
|
aurp.Inc(&nextConnID)
|
|
peers[udpAddrFromNet(raddr)] = peer
|
|
goPeerHandler(peer)
|
|
}
|
|
|
|
// --------------------------------- AARP ---------------------------------
|
|
aarpMachine := router.NewAARPMachine(cfg, pcapHandle, myHWAddr)
|
|
aarpCh := make(chan *ethertalk.Packet, 1024)
|
|
go aarpMachine.Run(ctx, aarpCh)
|
|
|
|
// --------------------------------- RTMP ---------------------------------
|
|
rtmpMachine := &router.RTMPMachine{
|
|
AARP: aarpMachine,
|
|
Config: cfg,
|
|
PcapHandle: pcapHandle,
|
|
RoutingTable: routes,
|
|
}
|
|
rtmpCh := make(chan *ddp.ExtPacket, 1024)
|
|
go rtmpMachine.Run(ctx, rtmpCh)
|
|
|
|
// -------------------------------- Router --------------------------------
|
|
rooter := &router.Router{
|
|
Config: cfg,
|
|
PcapHandle: pcapHandle,
|
|
MyHWAddr: myHWAddr,
|
|
// MyDDPAddr: ...,
|
|
RouteTable: routes,
|
|
ZoneTable: zones,
|
|
}
|
|
|
|
// ---------------------- Raw AppleTalk/AARP inbound ----------------------
|
|
go func() {
|
|
for {
|
|
if ctx.Err() != nil {
|
|
return
|
|
}
|
|
|
|
rawPkt, _, err := pcapHandle.ReadPacketData()
|
|
// if errors.Is(err, pcap.NextErrorTimeoutExpired) {
|
|
// continue
|
|
// }
|
|
if errors.Is(err, io.EOF) || errors.Is(err, pcap.NextErrorNoMorePackets) {
|
|
return
|
|
}
|
|
if err != nil {
|
|
log.Printf("Couldn't read AppleTalk / AARP packet data: %v", err)
|
|
return
|
|
}
|
|
|
|
ethFrame := new(ethertalk.Packet)
|
|
if err := ethertalk.Unmarshal(rawPkt, ethFrame); err != nil {
|
|
log.Printf("Couldn't unmarshal EtherTalk frame: %v", err)
|
|
continue
|
|
}
|
|
|
|
// Ignore if sent by me
|
|
if ethFrame.Src == myHWAddr {
|
|
continue
|
|
}
|
|
|
|
switch ethFrame.SNAPProto {
|
|
case ethertalk.AARPProto:
|
|
// log.Print("Got an AARP frame")
|
|
aarpCh <- ethFrame
|
|
|
|
case ethertalk.AppleTalkProto:
|
|
// log.Print("Got an AppleTalk frame")
|
|
ddpkt := new(ddp.ExtPacket)
|
|
if err := ddp.ExtUnmarshal(ethFrame.Payload, ddpkt); err != nil {
|
|
log.Printf("Couldn't unmarshal DDP packet: %v", err)
|
|
continue
|
|
}
|
|
log.Printf("DDP: src (%d.%d s %d) dst (%d.%d s %d) proto %d data len %d",
|
|
ddpkt.SrcNet, ddpkt.SrcNode, ddpkt.SrcSocket,
|
|
ddpkt.DstNet, ddpkt.DstNode, ddpkt.DstSocket,
|
|
ddpkt.Proto, len(ddpkt.Data))
|
|
|
|
// Glean address info for AMT
|
|
srcAddr := ddp.Addr{Network: ddpkt.SrcNet, Node: ddpkt.SrcNode}
|
|
aarpMachine.Learn(srcAddr, ethFrame.Src)
|
|
// log.Printf("DDP: Gleaned that %d.%d -> %v", srcAddr.Network, srcAddr.Node, ethFrame.Src)
|
|
|
|
// Packet for us? First, who am I?
|
|
myAddr, ok := aarpMachine.Address()
|
|
if !ok {
|
|
continue
|
|
}
|
|
rooter.MyDDPAddr = myAddr.Proto
|
|
|
|
// Our network?
|
|
// "The network number 0 is reserved to mean unknown; by default
|
|
// it specifies the local network to which the node is
|
|
// connected. Packets whose destination network number is 0 are
|
|
// addressed to a node on the local network."
|
|
// TODO: more generic routing
|
|
if ddpkt.DstNet != 0 && !(ddpkt.DstNet >= cfg.EtherTalk.NetStart && ddpkt.DstNet <= cfg.EtherTalk.NetEnd) {
|
|
// Is it for a network in the routing table?
|
|
rt := routes.LookupRoute(ddpkt.DstNet)
|
|
if rt == nil {
|
|
log.Printf("DDP: no route for network %d", ddpkt.DstNet)
|
|
continue
|
|
}
|
|
|
|
// Encap ethPacket.Payload into an AURP packet
|
|
log.Printf("DDP: forwarding to AURP peer %v", rt.Peer.RemoteAddr)
|
|
if _, err := rt.Peer.Send(rt.Peer.Transport.NewAppleTalkPacket(ethFrame.Payload)); err != nil {
|
|
log.Printf("DDP: Couldn't forward packet to AURP peer: %v", err)
|
|
}
|
|
|
|
continue
|
|
}
|
|
|
|
// To me?
|
|
// "Node ID 0 indicates any router on the network"- I'm a router
|
|
// "node ID $FF indicates either a network-wide or zone-specific
|
|
// broadcast"- that's relevant
|
|
if ddpkt.DstNode != 0 && ddpkt.DstNode != 0xff && ddpkt.DstNode != myAddr.Proto.Node {
|
|
continue
|
|
}
|
|
|
|
switch ddpkt.DstSocket {
|
|
case 1: // The RTMP socket
|
|
rtmpCh <- ddpkt
|
|
|
|
case 2: // The NIS (name information socket / NBP socket)
|
|
if err := rooter.HandleNBP(ethFrame.Src, ddpkt); err != nil {
|
|
log.Printf("NBP: Couldn't handle: %v", err)
|
|
}
|
|
|
|
case 4: // The AEP socket
|
|
if err := rooter.HandleAEP(ethFrame.Src, ddpkt); err != nil {
|
|
log.Printf("AEP: Couldn't handle: %v", err)
|
|
}
|
|
|
|
case 6: // The ZIS (zone information socket / ZIP socket)
|
|
if err := rooter.HandleZIP(ctx, ethFrame.Src, ddpkt); err != nil {
|
|
log.Printf("ZIP: couldn't handle: %v", err)
|
|
}
|
|
|
|
default:
|
|
log.Printf("DDP: No handler for socket %d", ddpkt.DstSocket)
|
|
}
|
|
|
|
default:
|
|
log.Printf("Read unknown packet %s -> %s with payload %x", ethFrame.Src, ethFrame.Dst, ethFrame.Payload)
|
|
|
|
}
|
|
}
|
|
}()
|
|
|
|
// ----------------------------- AURP inbound -----------------------------
|
|
go func() {
|
|
for {
|
|
if ctx.Err() != nil {
|
|
return
|
|
}
|
|
// ln.SetReadDeadline(time.Now().Add(100 * time.Millisecond))
|
|
pktbuf := make([]byte, 4096)
|
|
pktlen, raddr, readErr := ln.ReadFromUDP(pktbuf)
|
|
|
|
// var operr *net.OpError
|
|
// if errors.As(readErr, &operr) && operr.Timeout() {
|
|
// continue
|
|
// }
|
|
|
|
// log.Printf("AURP: Received packet of length %d from %v", pktlen, raddr)
|
|
|
|
dh, pkt, parseErr := aurp.ParsePacket(pktbuf[:pktlen])
|
|
if parseErr != nil {
|
|
log.Printf("AURP: Failed to parse packet: %v", parseErr)
|
|
continue
|
|
}
|
|
if readErr != nil {
|
|
log.Printf("AURP: Failed to read packet: %v", readErr)
|
|
return
|
|
}
|
|
|
|
log.Printf("AURP: Got %T from %v (%v)", pkt, raddr, dh.SourceDI)
|
|
|
|
// Existing peer?
|
|
ra := udpAddrFromNet(raddr)
|
|
pr := peers[ra]
|
|
if pr == nil {
|
|
// New peer!
|
|
pr = &router.Peer{
|
|
Config: cfg,
|
|
Transport: &aurp.Transport{
|
|
LocalDI: localDI,
|
|
RemoteDI: dh.SourceDI, // platinum rule
|
|
LocalConnID: nextConnID,
|
|
},
|
|
UDPConn: ln,
|
|
RemoteAddr: raddr,
|
|
RecieveCh: make(chan aurp.Packet, 1024),
|
|
RoutingTable: routes,
|
|
ZoneTable: zones,
|
|
Reconnect: false,
|
|
}
|
|
aurp.Inc(&nextConnID)
|
|
peers[ra] = pr
|
|
goPeerHandler(pr)
|
|
}
|
|
|
|
switch dh.PacketType {
|
|
case aurp.PacketTypeRouting:
|
|
// It's AURP routing data.
|
|
// Pass the packet to the goroutine in charge of this peer.
|
|
select {
|
|
case pr.RecieveCh <- pkt:
|
|
// That's it for us.
|
|
|
|
case <-ctx.Done():
|
|
return
|
|
}
|
|
continue
|
|
|
|
case aurp.PacketTypeAppleTalk:
|
|
apkt, ok := pkt.(*aurp.AppleTalkPacket)
|
|
if !ok {
|
|
log.Printf("AURP: Got %T but domain header packet type was %v ?", pkt, dh.PacketType)
|
|
continue
|
|
}
|
|
|
|
// Route or otherwise handle the encapsulated AppleTalk traffic
|
|
ddpkt := new(ddp.ExtPacket)
|
|
if err := ddp.ExtUnmarshal(apkt.Data, ddpkt); err != nil {
|
|
log.Printf("AURP: Couldn't unmarshal encapsulated DDP packet: %v", err)
|
|
continue
|
|
}
|
|
log.Printf("DDP/AURP: Got %d.%d.%d -> %d.%d.%d proto %d data len %d",
|
|
ddpkt.SrcNet, ddpkt.SrcNode, ddpkt.SrcSocket,
|
|
ddpkt.DstNet, ddpkt.DstNode, ddpkt.DstSocket,
|
|
ddpkt.Proto, len(ddpkt.Data))
|
|
|
|
// "Route" the packet
|
|
// Since for now there's only one local network, the routing
|
|
// decision is pretty easy
|
|
// TODO: Fix this to support other AppleTalk routers
|
|
if ddpkt.DstNet < cfg.EtherTalk.NetStart || ddpkt.DstNet > cfg.EtherTalk.NetEnd {
|
|
log.Print("DDP/AURP: dropping packet not addressed to our EtherTalk range")
|
|
continue
|
|
}
|
|
|
|
// Check and adjust the Hop Count
|
|
// Note the ddp package doesn't make this simple
|
|
hopCount := (ddpkt.Size & 0x3C00) >> 10
|
|
if hopCount >= 15 {
|
|
log.Printf("DDP/AURP: hop count exceeded (%d >= 15)", hopCount)
|
|
continue
|
|
}
|
|
hopCount++
|
|
ddpkt.Size &^= 0x3C00
|
|
ddpkt.Size |= hopCount << 10
|
|
|
|
// Is it addressed to me? Is it NBP?
|
|
if ddpkt.DstNode == 0 { // Node 0 = the router for the network
|
|
if ddpkt.DstSocket != 2 {
|
|
// Something else?? TODO
|
|
log.Printf("DDP/AURP: I don't have anything 'listening' on socket %d", ddpkt.DstSocket)
|
|
continue
|
|
}
|
|
// It's NBP
|
|
if err := rooter.HandleNBPInAURP(pr, ddpkt); err != nil {
|
|
log.Printf("NBP/DDP/AURP: %v", err)
|
|
}
|
|
continue
|
|
}
|
|
|
|
// Note: resolving AARP can block
|
|
if err := rooter.SendEtherTalkDDP(ctx, ddpkt); err != nil {
|
|
log.Printf("DDP/AURP: couldn't send Ethertalk out: %v", err)
|
|
}
|
|
continue
|
|
|
|
default:
|
|
log.Printf("AURP: Got unknown packet type %v", dh.PacketType)
|
|
}
|
|
}
|
|
}()
|
|
}
|
|
|
|
// Hashable net.UDPAddr
|
|
type udpAddr struct {
|
|
ipv4 [4]byte
|
|
port uint16
|
|
}
|
|
|
|
func udpAddrFromNet(a *net.UDPAddr) udpAddr {
|
|
return udpAddr{
|
|
ipv4: [4]byte(a.IP.To4()),
|
|
port: uint16(a.Port),
|
|
}
|
|
}
|
|
|
|
func (u udpAddr) toNet() *net.UDPAddr {
|
|
return &net.UDPAddr{
|
|
IP: u.ipv4[:],
|
|
Port: int(u.port),
|
|
}
|
|
}
|