jrouter/main.go

package main

import (
	"bytes"
	"flag"
	"log"
	"net"
	"regexp"

	"gitea.drjosh.dev/josh/jrouter/aurp"
)

var hasPortRE = regexp.MustCompile(`:\d+$`)

var configFilePath = flag.String("config", "jrouter.yaml", "Path to configuration file to use")

type peer struct {
	tr    *aurp.Transport
	conn  *net.UDPConn
	raddr *net.UDPAddr
}

func (p *peer) dataReceiver() {
	// Write an Open-Req packet
	oreq := p.tr.NewOpenReqPacket(nil)
	var b bytes.Buffer
	if _, err := oreq.WriteTo(&b); err != nil {
		log.Printf("Couldn't write Open-Req packet to buffer: %v", err)
		return
	}
	n, err := p.conn.WriteToUDP(b.Bytes(), p.raddr)
	if err != nil {
		log.Printf("Couldn't write packet to peer: %v", err)
		return
	}
	log.Printf("Sent Open-Req (len %d) to peer %v", n, p.raddr)

}

func main() {
	flag.Parse()
	log.Println("jrouter")

	cfg, err := 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")
		}
	}

	log.Printf("Using %v as local domain identifier", localIP)

	peers := make(map[udpAddr]*peer)
	var nextConnID uint16

	ln, err := net.ListenUDP("udp4", &net.UDPAddr{Port: int(cfg.ListenPort)})
	if err != nil {
		log.Fatalf("Couldn't listen on udp4:387: %v", err)
	}
	defer ln.Close()
	log.Printf("Listening on %v", ln.LocalAddr())

	for _, peerStr := range cfg.Peers {
		if !hasPortRE.MatchString(peerStr) {
			peerStr += ":387"
		}

		raddr, err := net.ResolveUDPAddr("udp4", peerStr)
		if err != nil {
			log.Fatalf("Invalid UDP address: %v", err)
		}
		log.Printf("resolved %q to %v", peerStr, raddr)

		tr := &aurp.Transport{
			LocalDI:     aurp.IPDomainIdentifier(localIP),
			RemoteDI:    aurp.IPDomainIdentifier(raddr.IP),
			LocalConnID: nextConnID,
		}
		nextConnID++

		// conn, err := net.DialUDP("udp4", nil, raddr)
		// if err != nil {
		// 	log.Printf("Couldn't dial %v->%v: %v", nil, raddr, err)
		// 	continue
		// }
		// log.Printf("conn.LocalAddr = %v", conn.LocalAddr())

		peer := &peer{
			tr:    tr,
			conn:  ln,
			raddr: raddr,
		}
		go peer.dataReceiver()

		peers[udpAddrFromNet(raddr)] = peer
	}

	// Incoming packet loop
	pb := make([]byte, 65536)
	for {
		pktlen, raddr, readErr := ln.ReadFromUDP(pb)
		// net.PacketConn.ReadFrom: "Callers should always process
		// the n > 0 bytes returned before considering the error err."

		log.Printf("Received packet of length %d from %v", pktlen, raddr)

		dh, _, parseErr := aurp.ParseDomainHeader(pb[:pktlen])
		if parseErr != nil {
			log.Printf("Failed to parse domain header: %v", err)
		}

		pkt, parseErr := aurp.ParsePacket(pb[:pktlen])
		if parseErr != nil {
			log.Printf("Failed to parse packet: %v", parseErr)
		}

		log.Printf("The packet parsed succesfully as a %T", pkt)

		if readErr != nil {
			log.Printf("Failed to read packet: %v", readErr)
			continue
		}

		// Existing peer?
		ra := udpAddrFromNet(raddr)
		pr := peers[ra]
		if pr == nil {
			// New peer!
			nextConnID++
			pr = &peer{
				tr: &aurp.Transport{
					LocalDI:     aurp.IPDomainIdentifier(localIP),
					RemoteDI:    dh.SourceDI, // platinum rule
					LocalConnID: nextConnID,
				},
				conn:  ln,
				raddr: raddr,
			}
			peers[ra] = pr
		}

		switch p := pkt.(type) {
		case *aurp.AppleTalkPacket:
			// Probably something like:
			//
			// * parse the DDP header
			// * check that this is headed for our local network
			// * write the packet out in an EtherTalk frame
			//
			// or maybe if we were implementing a "central hub"
			//
			// * parse the DDP header
			// * see if we know the network
			// * forward to the peer with that network and lowest metric

		case *aurp.OpenReqPacket:
			// The peer tells us their connection ID in Open-Req.
			pr.tr.RemoteConnID = p.ConnectionID

			// Formulate a response.
			var rp *aurp.OpenRspPacket
			switch {
			case p.Version != 1:
				// Respond with Open-Rsp with unknown version error.
				rp = pr.tr.NewOpenRspPacket(0, aurp.ErrCodeInvalidVersion, nil)

			case len(p.Options) > 0:
				// Options? OPTIONS? We don't accept no stinkin' _options_
				rp = pr.tr.NewOpenRspPacket(0, aurp.ErrCodeOptionNegotiation, nil)

			default:
				// Accept it I guess.
				rp = pr.tr.NewOpenRspPacket(0, 1, nil)
			}

			log.Printf("Responding with %T", rp)

			// Write an Open-Rsp packet
			var b bytes.Buffer
			if _, err := rp.WriteTo(&b); err != nil {
				log.Printf("Couldn't create response packet: %v", err)
				break
			}
			if _, err := ln.WriteToUDP(b.Bytes(), raddr); err != nil {
				log.Printf("Couldn't write response packet to UDP peer %v: %v", raddr, err)
			}

		case *aurp.OpenRspPacket:
			if p.RateOrErrCode < 0 {
				// It's an error code.
				log.Printf("Open-Rsp error code from peer %v: %d", raddr.IP, p.RateOrErrCode)
			}

			// TODO

		}
	}
}

// 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),
	}
}